Skip to content

Commit

Permalink
feat: Updated arm movement error handling to including execution info
Browse files Browse the repository at this point in the history
  • Loading branch information
figuernd committed May 16, 2024
1 parent 180f444 commit cd6700e
Showing 1 changed file with 2 additions and 3 deletions.
5 changes: 2 additions & 3 deletions src/phyto_arm/src/arm_base.py
Original file line number Diff line number Diff line change
Expand Up @@ -108,13 +108,12 @@ def winch_done(state, move_result):
# Ensure winch move was successful
assert state == actionlib.GoalStatus.SUCCEEDED


# Free up semaphore for another winch movement
assert self.release_clearance()
callback(move_result)
except Exception as e:
rospy.logerr(f'Unexpected error: {e}')
rospy.signal_shutdown(f'Shutting down due to unexpected error: {e}')
rospy.logerr(f'Unexpected error during winch movement', exc_info=True)
rospy.signal_shutdown(f'Shutting down due to unexpected winch movement error')
raise e

self.winch_client.send_goal(MoveToDepthGoal(depth=depth, velocity=speed), done_cb=winch_done)
Expand Down

0 comments on commit cd6700e

Please sign in to comment.