Merge pull request #162 from PJTNT11/master

Some angle sensor work (not done)
cleaning up angle reset work
more cleanup
Merge pull request #27 from pstephen43/master

Finished cleaning up angle sensor work