Started Coding for Autonomous

Everything still works

+ The robot now turns to straighten up and then moves forward endlessly
in autonomous