set motion_possible to true only of robot can be actually moved

Felix Exner · Felix Exner · commit de535e19d4d7 · 2020-04-14T10:44:08.000+02:00
diff --git a/ur_robot_driver/src/ros/hardware_interface.cpp b/ur_robot_driver/src/ros/hardware_interface.cpp
@@ -695,10 +695,14 @@ void HardwareInterface::extractRobotStatus()
   {
     robot_status_resource_.motion_possible = TriState::FALSE;
   }
-  else
+  else if (robot_mode_ == ur_dashboard_msgs::RobotMode::RUNNING || robot_mode_ == ur_dashboard_msgs::RobotMode::BACKDRIVE)
   {
     robot_status_resource_.motion_possible = TriState::TRUE;
   }
+  else
+  {
+    robot_status_resource_.motion_possible = TriState::FALSE;
+  }
 
   // the error code, if any, is not transmitted by this protocol
   // it can and should be fetched separately

Original file line number	Diff line number	Diff line change
`@@ -695,10 +695,14 @@ void HardwareInterface::extractRobotStatus()`
`695`	`695`	`{`
`696`	`696`	`robot_status_resource_.motion_possible = TriState::FALSE;`
`697`	`697`	`}`
`698`		`- else`
	`698`	`+ else if (robot_mode_ == ur_dashboard_msgs::RobotMode::RUNNING \|\| robot_mode_ == ur_dashboard_msgs::RobotMode::BACKDRIVE)`
`699`	`699`	`{`
`700`	`700`	`robot_status_resource_.motion_possible = TriState::TRUE;`
`701`	`701`	`}`
	`702`	`+ else`
	`703`	`+ {`
	`704`	`+ robot_status_resource_.motion_possible = TriState::FALSE;`
	`705`	`+ }`
`702`	`706`
`703`	`707`	`// the error code, if any, is not transmitted by this protocol`
`704`	`708`	`// it can and should be fetched separately`