Adding Autonomous drive mode with Ultrasonic
Adding Autonomous drive mode with Ultrasonic
Added a 'drive in circles' method in chassis to test autonomous rotation.
Fixed code for autonomous driving
Minor changes to chassis code