Merge pull request #1 from WPI-RAIL/develop

cmdunkers
Merged my changes
Switched to front
Merge pull request #15 from cmdunkers/develop

Code for front servo tested