Implemented servo function. Renamed Autonomous.class to VehicleMovements and added 4 diagonal movements