Added exception handling for stop_servo
TODO comment for stop_servo exception handling