Ask Your Question

Robot manipulator waypoint trajectory planning and execution

asked 2013-03-12 18:32:42 -0500

I would like to create a robot program that reads in a set of arm waypoints from a file and then executes a trajectory through those waypoints. It seems like this should already exist?

Assuming it doesn't I plan to use a planner to plan the segments individually and then apply a filter to the whole path. This will require multiple service calls and could take a while. Is there a better approach?

Also, is there an xml/yaml format and parser somewhere that I could use for this. Seems straightforward enough, but I would like to reuse code/formats if they already exist.

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted

answered 2013-03-12 23:42:53 -0500

Adolfo Rodriguez T gravatar image

What follows is based on the arm_navigation stack. A similar alternative might exist for MoveIt, but I'm not familiar with it.

  • Converting a set of position waypoints to a spline trajectory can be done with the spline_smoother package. This won't plan collision free trajectories in between, though.

  • For generating collision-free paths between waypoints, your suggestion makes sense: call the motion planner n times, and then concatenate the results in a single trajectory which you would then filter. This would allow nonzero velocities at the waypoints, which seems a desirable feature. This scenario is a generalization of the existing move_arm action, where instead of a single goal-directed motion you also have intermediate waypoints.

  • Concerning the trajectory format, I am not aware of anything other than the existing [robot|joint]_trajectory messages. They seem sufficient for the described use case. For the waypoint-only description, specify only the fields you know in advance.

  • On a related note, an also interesting use case would be to execute an existing fully specified trajectory, but prepend to it a collision-free approach trajectory starting at the current state. A nonzero velocity transition between approach and specified trajectory would be desired.

edit flag offensive delete link more

Your Answer

Please start posting anonymously - your entry will be published after you log in or create a new account.

Add Answer

Question Tools



Asked: 2013-03-12 18:32:42 -0500

Seen: 840 times

Last updated: Mar 12 '13