This repository was archived by the owner on Nov 13, 2017. It is now read-only.
File tree Expand file tree Collapse file tree 1 file changed +5
-7
lines changed
move_group/src/default_capabilities Expand file tree Collapse file tree 1 file changed +5
-7
lines changed Original file line number Diff line number Diff line change @@ -70,14 +70,12 @@ bool move_group::MoveGroupExecuteService::executeTrajectoryService(moveit_msgs::
70
70
moveit_controller_manager::ExecutionStatus es = context_->trajectory_execution_manager_ ->waitForExecution ();
71
71
if (es == moveit_controller_manager::ExecutionStatus::SUCCEEDED)
72
72
res.error_code .val = moveit_msgs::MoveItErrorCodes::SUCCESS;
73
+ else if (es == moveit_controller_manager::ExecutionStatus::PREEMPTED)
74
+ res.error_code .val = moveit_msgs::MoveItErrorCodes::PREEMPTED;
75
+ else if (es == moveit_controller_manager::ExecutionStatus::TIMED_OUT)
76
+ res.error_code .val = moveit_msgs::MoveItErrorCodes::TIMED_OUT;
73
77
else
74
- if (es == moveit_controller_manager::ExecutionStatus::PREEMPTED)
75
- res.error_code .val = moveit_msgs::MoveItErrorCodes::PREEMPTED;
76
- else
77
- if (es == moveit_controller_manager::ExecutionStatus::TIMED_OUT)
78
- res.error_code .val = moveit_msgs::MoveItErrorCodes::TIMED_OUT;
79
- else
80
- res.error_code .val = moveit_msgs::MoveItErrorCodes::CONTROL_FAILED;
78
+ res.error_code .val = moveit_msgs::MoveItErrorCodes::CONTROL_FAILED;
81
79
// wait for all planning scene updates to be processed
82
80
context_->planning_scene_monitor_ ->syncUpdates (ros::Time::now ());
83
81
ROS_INFO_STREAM (" Execution completed: " << es.asString ());
You can’t perform that action at this time.
0 commit comments