Revision history [back]

In the code try using publishTrajectoryLine() as shown in the docs here, that is, having the End Effector link also as input for the function additionally to the trajectory, joint_model_group and the line color. Here is an example:

visual_tools_->publishTrajectoryLine(my_plan.trajectory_, joint_model_group->getLinkModel("tcp_link"), joint_model_group, rvt::LIME_GREEN);

Where as "tcp_link" is my end effector link name for Moveit. I was having the same problem and this is what worked for me.