Autonomus Update

Only issue is that disabled most of the code to try and test the robot's
encoded movement. Apparently its still not functioning correctly as it
continues to move without stopped at all.