Skip to content

Commit

Permalink
Checks Execution Error System Output to determine whether robot is in…
Browse files Browse the repository at this point in the history
… error
  • Loading branch information
keerthanamanivannan committed Jan 9, 2019
1 parent 58de0d0 commit 2f67d2d
Showing 1 changed file with 2 additions and 4 deletions.
6 changes: 2 additions & 4 deletions abb_driver/rapid/ROS_stateServer.mod
Original file line number Diff line number Diff line change
Expand Up @@ -82,6 +82,7 @@ ENDPROC
! signalMotionPossible : System Output
! signalRobotActive : System Output
! signalRobotNotMoving : System Output
! signalExecutionError : System Output
LOCAL PROC send_status()
VAR ROS_msg_robot_status message;

Expand Down Expand Up @@ -125,11 +126,8 @@ LOCAL PROC send_status()
message.drives_powered := ROS_TRISTATE_FALSE;
ENDIF

! Get error code
message.error_code := ERRNO;

! Determine in_error
if (message.error_code >= 1) AND (message.error_code <= 90) THEN
if DOutput(signalExecutionError) = 1 THEN
message.in_error := ROS_TRISTATE_TRUE;
ELSE
message.in_error := ROS_TRISTATE_FALSE;
Expand Down

0 comments on commit 2f67d2d

Please sign in to comment.