Merge pull request #10 from TheTimeLord/master

Added Climbing code
Further vision, refining sorting algorithm
Added code to disable and re-enable the joystick
Made a shifter between the DriveTrain and the Arms, and then corrected the code that uses the arms.
Fixed port assignments to match the standard
Removed TargetSorting
Reworked automatic targeting and alignment to not be dependent on last year's target formats
Fixed port assignments to match the standard
Removed TargetSorting
Reworked automatic targeting and alignment to not be dependent on last year's target formats
Fixed port assignments to match the standard
added pause command
fixed code for FrontPusherClimbOver and RearPusherClimbOver
made front pusher command be able to chose its position
Set a joystick button for manually extending and contracting the arms. Corrected the commands to trn motors off on arms.
Working on climbing to Loren's algorithm, bug fixes.
Fixed variable names that are in RobotMap that changed with JD's renumbering.
Corrected the DriveTrain powerTakeoff for the wheels/arms shifting to use a Solenoid rather than a relay
changed names for front and rear solenoids based off JD's changes
Small changes to climbing code to test the code when the robot is ready.