Extract just the path (in coordinates) instead of trajectories from MoveIt!

asked 2017-02-23 21:15:38 -0500

Wen Xin gravatar image

updated 2017-02-24 02:52:56 -0500

Hello all,

From what i know, when using OMPL.app (Graphical User Interface to OMPL), we can actually "print" a path to an output file by using

 ompl::geometric::PathGeometric::printAsMatrix()

And from MoveIt!, move_group pulls all the individual components together to provide "cmd_vel" (geometry_msgs/Twist). My question is, is it possible to print only the path from move_group and how?

Any help would be greatly appreciated. Thank you.

edit retag flag offensive close merge delete

Comments

MoveIt! does not produce Twist messages. It only generates RobotTrajectory instances, which are ultimately typically transformed into a JointTrajectory msg. Are you sure you're not confusing move_group with move_base? The latter is from the ROS Navigation stack.

gvdhoorn gravatar image gvdhoorn  ( 2017-02-24 00:41:53 -0500 )edit

@gvdhoorn Thanks for the explanation. If i were to extract just the path (in coordinates) instead of trajectories from MoveIt!, will it be possible?

Wen Xin gravatar image Wen Xin  ( 2017-02-24 01:18:01 -0500 )edit

I don't know of any functionality (on the user side) in MoveIt that would let you print out trajectories like this.

What you could perhaps do is subscribe to the FollowJointTrajectory topic(s) or use rostopic echo .. > my_file.yaml.

gvdhoorn gravatar image gvdhoorn  ( 2017-02-24 01:48:27 -0500 )edit

Also, could I ask you to tell us what the status is of #q255217 and #q254927?

gvdhoorn gravatar image gvdhoorn  ( 2017-02-24 01:49:26 -0500 )edit

@gvdhoorn Alright, thanks for clearing up my doubts! and yes, i will update the status of #q255217 and #q254927 as soon as possible.

Wen Xin gravatar image Wen Xin  ( 2017-02-24 02:38:53 -0500 )edit

Joint trajectories are composed of joint trajectory points, in which the joint positions for each point along the trajectory are provided. With this you can compute FK to obtain the Cartesian position for each joint trajectory point.

JoshMarino gravatar image JoshMarino  ( 2017-02-24 07:34:05 -0500 )edit