Initial fix. UNTESTED.
Moved gyro temperature offset calibration to in front of rotation.
Formatting fixes.
Moved gyroscope accumulation after bias temperature correction.