more work on fram math
Merge branch 'development' of https://github.com/FRC-Team-1160/Command-Based-Robot into development
added an sd reporter temp code for testing