Simpler serial.
Increase serial buffer size.
Remove some I2C debugging.
Add ability to set compass offset.
Remove debugging from publish.
IMU updates. Fix sign on compass.
Clean up timer interrupt a bit.
Publish sonars one at a time.