When the wrist safety node is triggered it does not reset in the same way as the bumber and airskin. Could it be implemented similarly so that we do not have to manually reset the wrist. Also, the while loop (line 41) should be
while(ros::ok()){ ... }
not
while(1){ ... }
to ensure that the node is correctly terminated from the terminal.