Quaternion Invariant Cubature Kalman Filtering for Attitude Estimation

This paper presents a novel nonlinear filtering method for attitude estimation of rigid bodies, called the invariant cubature Kalman filter. This method combines the theory of invariant observer and cubature Kalman filter. When using the cubature filter formulas, the proposed method can maintain the invariance of system dynamics and calculate the estimated state with the geometrical correction ter...