Update Teleop and Autonomous to fix bugs

Fix Bugs and normalized motors.