WIP: Realized that more thorough IMU calibration needed.
Updated ChibiOS to latest master.
Moved data files to imu_calibration/
Determined sensor orientation, scale factor, bias