Added Teleop Phase. Driving only. Old config.