Unverified Commit acfffd42 authored by Felix Exner's avatar Felix Exner Committed by GitHub
Browse files

Always go through updateRobotState function in goal callback (#99)

When robot is already in the target mode (safety- and robot mode) and the set_mode
action is called with requesting to start the program afterwards, the program
did not start as the robot already was at the desired state.
However, e.g. after a protective stop that is resolved by hand (e.g. when driving
into joint limits) users expected to call that action to restart the robot
again.

With this change, we do the usual check whether to start the program again.
This way, this action can always be used to make sure the robot is running with
the program correctly.
parent 69368903
......@@ -210,9 +210,9 @@ void RobotStateHelper::setModeGoalCallback()
}
else
{
result_.success = true;
result_.message = "Target mode already active. Nothing to do here.";
set_mode_as_.setSucceeded(result_);
// There is no transition to do here, but we have to start the program again, if desired.
// This happens inside updateRobotState()
updateRobotState();
}
break;
case RobotMode::NO_CONTROLLER:
......
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment