[Calibration]: This fixes a bad gyroscope calibration that would occur
when calibrating at unusual attitudes. Because the gyro bias accumulators
were working during the inital convergence phase, they would carry over
false data. This resolves the bug by forcing the integrators to 0 until
the calibration phase is completed.
Refactor the accelerometer filtering pathway to make it clearer and shorter.