added gyro code and smartdashboard stuff.
Merge origin/master