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

Moveit - Extract path

asked 2016-09-09 07:12:35 -0500

Soho_ gravatar image


I am using the cartesian path planner plugin and it somehow works. I can visualize the movement for a given goal point.

But how can I extract all the intermediate points from the trajectory? I would like to plot them.

Alternatively, how could I achieve this without plugin?

Thank you very much

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted

answered 2016-09-09 16:36:07 -0500

JoshMarino gravatar image

updated 2016-09-09 18:38:21 -0500

Hi there,

If you are planning with MoveIt! using the MoveGroupCommander (python/C++), you can inspect the trajectory that was planned. I do this by the following:

plan_manipulator = group_manipulator.plan()

print plan_manipulator.joint_trajectory.points.positions

More information about joint_trajectory msgs can be found here.

This will allow you to inspect the positions of each way point in the trajectory. Rather than printing them to screen, you can plot them with your favorite tool.

edit flag offensive delete link more


oh that sounds great. do you have the general skeleton of your code? the moveit tutorial website is down right now for some reason..

Soho_ gravatar image Soho_  ( 2016-09-13 03:45:48 -0500 )edit

thank you. but I want to use a different robot description. where should I put my .urdf file?

Soho_ gravatar image Soho_  ( 2016-09-14 08:20:59 -0500 )edit

Do you already have a moveit_config package made from your URDF? If not, look at the tutorials with moveit_setup_assistant.

JoshMarino gravatar image JoshMarino  ( 2016-09-14 18:46:38 -0500 )edit

Question Tools



Asked: 2016-09-09 07:12:35 -0500

Seen: 1,342 times

Last updated: Sep 09 '16