ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange
Ask Your Question

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

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


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 image Stefan 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 image dbworth  ( 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:

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

Question Tools


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

Seen: 515 times

Last updated: Feb 07 '13