RobotPickUp

Changed and simplified code
Merge branch 'master' of https://github.com/Nathan-Fenner/AdamBots-2014-FRC-Programming