Post-Competition/Autonomous Updates

Changed control schemes to better serve the driver
Modified autonomous code for new robot
Turning is now accurate
Started autonomous routes for the towers
TODO: add lift ultrasonic to functions