Merge pull request #27 from pstephen43/master

Finished cleaning up angle sensor work
Fixed includes
Merge branch 'master' of https://github.com/PJTNT11/FTC5037GR into PJTNT11-master