Added some smartdashboard code to display the servo's X and Y.
Merge pull request #3 from TrojanRobotics/SmartDashboard

SmartDashboard code for servo