-Cleaned test code
-IMPORTANT Encoder is not implemented in test mode
Merge branch 'master' of https://github.com/FRCTeam1719/2014Robot/