V5.3  Minor changes

-Added motor shutoff function
-Added a few debugging items to try and figure out ultrasonic issue