Ask Your Question
0

KDL iterative IK solver joint angles not normalized

asked 2013-02-07 03:29:11 -0500

I'm using the arm_kinematics_tools package for solving the IK of a 6DOF arm. Everything is working fine, with the little caveat that the returned joint angles are not normalized.

An example:

position: [577.1623005464028, 565.4397480457859, 43040.16494263808, 441.2180765483309, -17007.80488691719, 939.0145541995307]

If those are sent to the robot_state_publisher, the arm position is fine, implying that the angles are correct, just not normalized. I'm aware that this behavior is also related to the seed state, but I was wondering if this is normal/intended behavior of KDL and if others have experienced this too.

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted
2

answered 2013-02-07 04:47:18 -0500

dbworth gravatar image

Hi, I remember seeing that too. In the package you'll find there are 3 types of the Newton-Raphson solver you can test. I found only one of them had this behaviour. The "best" of the three, with joint limits, did not.

But, for a 6 DOF robot, I'd generate an IKFast plugin. ;-)

edit flag offensive delete link more

Comments

Ah ok, thanks :) Yes, I'd do that too (re IKFast), unfortunately there are some kinematics for which closed form IK generation fails.

Stefan Kohlbrecher gravatar imageStefan Kohlbrecher ( 2013-02-07 05:00:08 -0500 )edit

DRC arm or snake robot? ;-) The basic N.R. solver is very bad. Using KDL to make a Jacobian-based solver is one, better option.

dbworth gravatar imagedbworth ( 2013-02-07 05:19:34 -0500 )edit

There's functions in the KDL library to do with jacobians. I think the NASA R2 uses one, as does REEM: https://github.com/pal-robotics/reem_kinematics/blob/master/reem_kinematics_constraint_aware/src/ik_solver.cpp

dbworth gravatar imagedbworth ( 2013-02-07 12:04:33 -0500 )edit

Your Answer

Please start posting anonymously - your entry will be published after you log in or create a new account.

Add Answer

Question Tools

Stats

Asked: 2013-02-07 03:29:11 -0500

Seen: 345 times

Last updated: Feb 07 '13