- Almost have tilt-compensation working
- Messy code. Need to clean up.
- Added new IMU class to contain compass and accelerometer classes for cleaner code
- Functionally same as last commit
- Heading off several degrees from North but tilt-compensations appears to be working