Kalman filter: Replaced axis-angle representation in state with quaternion