Working Madera Code

This is the code that was used to run the 2016 robot at Madera. It has only manual control.
-Vision and all references removed
-Intake PID removed
-Correct port map
-All the correct inversions of sensors/motors