adds a getAngle method
Merge branch 'develop' of https://github.com/2729StormRobotics/Storm2014 into develop