扩展卡尔曼滤波 基于ADouble-StageKalmanFilterforOrientationTrackingWithanIntegratedProcessorin9-DIMU中论文的实现,基于EKF-IMU算法的实现,基于ESKF-IMU算法的实现