Autonomous & DriveSystem

I actually added the movement methods to the autonomous. Hopefully, this
will work. We shouldn't have to change autonomous any more.
I changed the Autonomous Drive type (with Bennet's permission) from
mecanum_cartesian to mecanum_polar. It's almost impossible to control it
in autonomous with Decarte mode... :D