@@ -106,7 +106,7 @@ int main(int argc, char** argv)
106
106
visual_tools.publishAxisLabeled (target_pose1.pose , " target_pose" );
107
107
visual_tools.publishText (text_pose, " setStartStateToCurrentState" , rvt::WHITE, rvt::XLARGE);
108
108
// Visualize the trajectory in Rviz
109
- visual_tools.publishTrajectoryLine (plan_solution1.trajectory , joint_model_group_ptr);
109
+ visual_tools.publishTrajectoryLine (plan_solution1.trajectory_ , joint_model_group_ptr);
110
110
visual_tools.trigger ();
111
111
112
112
/* Uncomment if you want to execute the plan */
@@ -145,12 +145,12 @@ int main(int argc, char** argv)
145
145
if (plan_solution2)
146
146
{
147
147
moveit::core::RobotState robot_state (robot_model_ptr);
148
- moveit::core::robotStateMsgToRobotState (plan_solution2.start_state , robot_state);
148
+ moveit::core::robotStateMsgToRobotState (plan_solution2.start_state_ , robot_state);
149
149
150
150
visual_tools.publishAxisLabeled (robot_state.getGlobalLinkTransform (" panda_link8" ), " start_pose" );
151
151
visual_tools.publishAxisLabeled (target_pose1.pose , " target_pose" );
152
152
visual_tools.publishText (text_pose, " moveit::core::RobotState_Start_State" , rvt::WHITE, rvt::XLARGE);
153
- visual_tools.publishTrajectoryLine (plan_solution2.trajectory , joint_model_group_ptr);
153
+ visual_tools.publishTrajectoryLine (plan_solution2.trajectory_ , joint_model_group_ptr);
154
154
visual_tools.trigger ();
155
155
156
156
/* Uncomment if you want to execute the plan */
@@ -189,12 +189,12 @@ int main(int argc, char** argv)
189
189
if (plan_solution3)
190
190
{
191
191
moveit::core::RobotState robot_state (robot_model_ptr);
192
- moveit::core::robotStateMsgToRobotState (plan_solution3.start_state , robot_state);
192
+ moveit::core::robotStateMsgToRobotState (plan_solution3.start_state_ , robot_state);
193
193
194
194
visual_tools.publishAxisLabeled (robot_state.getGlobalLinkTransform (" panda_link8" ), " start_pose" );
195
195
visual_tools.publishAxisLabeled (target_pose2, " target_pose" );
196
196
visual_tools.publishText (text_pose, " moveit::core::RobotState_Goal_Pose" , rvt::WHITE, rvt::XLARGE);
197
- visual_tools.publishTrajectoryLine (plan_solution3.trajectory , joint_model_group_ptr);
197
+ visual_tools.publishTrajectoryLine (plan_solution3.trajectory_ , joint_model_group_ptr);
198
198
visual_tools.trigger ();
199
199
200
200
/* Uncomment if you want to execute the plan */
@@ -231,12 +231,12 @@ int main(int argc, char** argv)
231
231
if (plan_solution4)
232
232
{
233
233
moveit::core::RobotState robot_state (robot_model_ptr);
234
- moveit::core::robotStateMsgToRobotState (plan_solution4.start_state , robot_state);
234
+ moveit::core::robotStateMsgToRobotState (plan_solution4.start_state_ , robot_state);
235
235
236
236
visual_tools.publishAxisLabeled (robot_state.getGlobalLinkTransform (" panda_link8" ), " start_pose" );
237
237
visual_tools.publishAxisLabeled (robot_start_state->getGlobalLinkTransform (" panda_link8" ), " target_pose" );
238
238
visual_tools.publishText (text_pose, " Goal_Pose_From_Named_State" , rvt::WHITE, rvt::XLARGE);
239
- visual_tools.publishTrajectoryLine (plan_solution4.trajectory , joint_model_group_ptr);
239
+ visual_tools.publishTrajectoryLine (plan_solution4.trajectory_ , joint_model_group_ptr);
240
240
visual_tools.trigger ();
241
241
242
242
/* Uncomment if you want to execute the plan */
@@ -289,7 +289,7 @@ int main(int argc, char** argv)
289
289
if (plan_solution5)
290
290
{
291
291
visual_tools.publishText (text_pose, " Planning_Around_Collision_Object" , rvt::WHITE, rvt::XLARGE);
292
- visual_tools.publishTrajectoryLine (plan_solution5.trajectory , joint_model_group_ptr);
292
+ visual_tools.publishTrajectoryLine (plan_solution5.trajectory_ , joint_model_group_ptr);
293
293
visual_tools.trigger ();
294
294
295
295
/* Uncomment if you want to execute the plan */
0 commit comments