Kalman: Replaced angle-axis representation in state with quaternion