Ask Your Question
0

moveit getJacobian

asked 2018-12-12 02:59:57 -0600

Mike Ferenduros gravatar image

Hi! I had a problem with moveit's computeVariableVelocity, which I tracked down to a weird Jacobian matrix in my model. The robot has X, Y and Z prismatic joints, then a Z revolute. But with the joint-states all zeroed out, I'm getting a jacobian

  1.304  0.31889  0.41454        0
  -0.03  0.97173 -0.06256    0.575
0.19219  0.23349  2.48029        0
      0        0        0        0
      0        0        0        0
      0        0        0        1

which looks very wrong in a bunch of ways (not least, 1m of Z joint movement turns into 2.4m of worldspace Z!). Only the final revolute joint looks right.

Stepping into getJacobian, things seem to go wrong around line 1161:

joint_transform = reference_transform * getGlobalLinkTransform(link);
joint_axis = joint_transform * static_cast<const robot_model::PrismaticJointModel*>(pjm)->getAxis();

When I hit this line, getGlobalLinkTransform returns a valid matrix that includes translation. There's nothing in reference transform to cancel this out, so prismatic axis gets rotated and translated, and joint_axis ends up totally wonky.

Is there something wrong with my RobotModel here? Am I misunderstandingt the Jacobian?

edit retag flag offensive close merge delete

Comments

1

If you feel this is an issue with MoveIt, I would suggest to report it over at ros-planning/moveit/issues.

If you do, please try to include a reproducable example or nr of steps. That will greatly simplify debugging.

gvdhoorn gravatar imagegvdhoorn ( 2018-12-12 03:06:21 -0600 )edit

1 Answer

Sort by ยป oldest newest most voted
0

answered 2018-12-12 03:27:16 -0600

Mike Ferenduros gravatar image

Turns out it was indeed a moveit bug, fixed last month. https://github.com/ros-planning/movei...

edit flag offensive delete link more

Comments

1

Thanks for reporting back.

gvdhoorn gravatar imagegvdhoorn ( 2018-12-12 03:36:06 -0600 )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: 2018-12-12 02:59:09 -0600

Seen: 374 times

Last updated: Dec 12 '18