Commenting out ros_failsafe_check until debugged