Driving and Autonomous

Speeds up driving and improves autonomous.