SetFromIK results in unintended joint values

asked 2017-04-04 05:06:49 -0500

Broes De Cat gravatar image

updated 2017-04-07 03:34:50 -0500

Hi,

I'm trying to solve a planning task with moveit, where I get a cartesian target pose as input, but one of the planners only takes joint value targets, so I have to compute the IK separately. I noticed that while "movegroup->setPoseTarget(targetPose, iiwa_ee_link);" behaves as expected (for the planners that can handle it), "robotState->setFromIK(modelgroup, targetPose, iiwa_ee_link, 10, 0.1)" gives incorrect results and the result also depends on the current position. So my RobotModel does not seem to be using the reference frame I thought it was (the fixed world frame), but when I check robotModel->getModelFrame(), it is the world frame...

Any input would be welcome as I am quite stuck with this. I also logged it as an issue on moveit ( https://github.com/ros-planning/movei... ), but no ideas there yet, so maybe the larger community has an idea :)

Thanks! Broes

edit retag flag offensive close merge delete