New Autonomous and Movement Functions

Movement function were moved out of the autonomous code and into their
own C file. Also started code for new autonomous of ramp