Ask Your Question
0

Moveit - Extract path

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

Soho_ gravatar image

Hello,

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
0

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

JoshMarino gravatar image

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

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:

group_manipulator.set_pose_target(pose_target)  
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

Comments

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 imageSoho_ ( 2016-09-13 03:45:48 -0600 )edit

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

Soho_ gravatar imageSoho_ ( 2016-09-14 08:20:59 -0600 )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 imageJoshMarino ( 2016-09-14 18:46:38 -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

2 followers

Stats

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

Seen: 690 times

Last updated: Sep 09 '16