Removed all the issues and unnecessary code.

Fixed the cheesy vision drive auton.