Kalman integration

Integrating kalman filter. Acceleration not rotating completely, 9.33
m/s^2 in the vertical channel..