Autonomous and DriveSystem

I ADDED a method to Drivesystem, I didn't take anything away.
I also started moving autonomous into the new direction that we decided
on.