Ask Your Question

Revision history [back]

click to hide/show revision 1
initial version

publishTrajectoryLine(...) visualize the green trajectory line. while publishTrajectoryPath(...) visualize the simulated robot motions. Add the 2 following lines right after visual_tools.trigger():

visual_tools.publishTrajectoryPath(my_plan.trajectory_, my_plan.start_state_);
visual_tool->trigger();