@@ -92,7 +92,7 @@ int main(int argc, char** argv)
9292 visual_tools.publishAxisLabeled (target_pose1.pose , " target_pose" );
9393 visual_tools.publishText (text_pose, " Goal Pose" , rvt::WHITE, rvt::XLARGE);
9494 // Visualize the trajectory in Rviz
95- visual_tools.publishTrajectoryLine (plan_solution1.trajectory , joint_model_group_ptr);
95+ visual_tools.publishTrajectoryLine (plan_solution1.trajectory_ , joint_model_group_ptr);
9696 visual_tools.trigger ();
9797
9898 /* Uncomment if you want to execute the plan */
@@ -131,13 +131,13 @@ int main(int argc, char** argv)
131131 if (plan_solution2)
132132 {
133133 moveit::core::RobotState robot_state (robot_model_ptr);
134- moveit::core::robotStateMsgToRobotState (plan_solution2.start_state , robot_state);
134+ moveit::core::robotStateMsgToRobotState (plan_solution2.start_state_ , robot_state);
135135
136136 visual_tools.publishText (text_pose, " Start Pose" , rvt::WHITE, rvt::XLARGE);
137137 visual_tools.publishAxisLabeled (robot_state.getGlobalLinkTransform (" panda_link8" ), " start_pose" );
138138 visual_tools.publishText (text_pose, " Goal Pose" , rvt::WHITE, rvt::XLARGE);
139139 visual_tools.publishAxisLabeled (target_pose1.pose , " target_pose" );
140- visual_tools.publishTrajectoryLine (plan_solution2.trajectory , joint_model_group_ptr);
140+ visual_tools.publishTrajectoryLine (plan_solution2.trajectory_ , joint_model_group_ptr);
141141 visual_tools.trigger ();
142142
143143 /* Uncomment if you want to execute the plan */
@@ -176,13 +176,13 @@ int main(int argc, char** argv)
176176 if (plan_solution3)
177177 {
178178 moveit::core::RobotState robot_state (robot_model_ptr);
179- moveit::core::robotStateMsgToRobotState (plan_solution3.start_state , robot_state);
179+ moveit::core::robotStateMsgToRobotState (plan_solution3.start_state_ , robot_state);
180180
181181 visual_tools.publishText (text_pose, " Start Pose" , rvt::WHITE, rvt::XLARGE);
182182 visual_tools.publishAxisLabeled (robot_state.getGlobalLinkTransform (" panda_link8" ), " start_pose" );
183183 visual_tools.publishText (text_pose, " Goal Pose" , rvt::WHITE, rvt::XLARGE);
184184 visual_tools.publishAxisLabeled (target_pose2, " target_pose" );
185- visual_tools.publishTrajectoryLine (plan_solution3.trajectory , joint_model_group_ptr);
185+ visual_tools.publishTrajectoryLine (plan_solution3.trajectory_ , joint_model_group_ptr);
186186 visual_tools.trigger ();
187187
188188 /* Uncomment if you want to execute the plan */
@@ -219,13 +219,13 @@ int main(int argc, char** argv)
219219 if (plan_solution4)
220220 {
221221 moveit::core::RobotState robot_state (robot_model_ptr);
222- moveit::core::robotStateMsgToRobotState (plan_solution4.start_state , robot_state);
222+ moveit::core::robotStateMsgToRobotState (plan_solution4.start_state_ , robot_state);
223223
224224 visual_tools.publishText (text_pose, " Start Pose" , rvt::WHITE, rvt::XLARGE);
225225 visual_tools.publishAxisLabeled (robot_state.getGlobalLinkTransform (" panda_link8" ), " start_pose" );
226226 visual_tools.publishText (text_pose, " Goal Pose" , rvt::WHITE, rvt::XLARGE);
227227 visual_tools.publishAxisLabeled (robot_start_state->getGlobalLinkTransform (" panda_link8" ), " target_pose" );
228- visual_tools.publishTrajectoryLine (plan_solution4.trajectory , joint_model_group_ptr);
228+ visual_tools.publishTrajectoryLine (plan_solution4.trajectory_ , joint_model_group_ptr);
229229 visual_tools.trigger ();
230230
231231 /* Uncomment if you want to execute the plan */
0 commit comments