论文部分内容阅读
给出了一种利用修正罗德里格参数(Modified Rodrigues Parameters)进行姿态估计的算法.该算法用于利用矢量观测的无陀螺姿态和姿态角速度的确定,采用切换方法处理了修正罗德里格参数的奇异性问题,修正罗德里格参数的误差定义为从估计姿态到真实姿态的旋转.根据姿态误差运动方程,用扩展卡尔曼滤波方法设计了姿态和姿态角速度估计器,用数值算例验证了算法的可行性.