科研之友
微信
新浪微博
Facebook
分享链接
摘要
传统的克雷洛夫角法经过三次坐标轴旋转后得到姿态矩阵,此方法的缺点是当中间角接近±90°时,会出现退化现象,且姿态解算精度与三次旋转顺序相关联。针对以上克雷洛夫角法的不足,提出一种基于四次旋转的扩展克雷洛夫角的全姿态导航解算方法。首先,由计算得到的四次旋转下的克雷洛夫角坐标变换矩阵和角速度方程判断四个角度存在的冗余性,并进行约束。其次,为了得到导航姿态的唯一响应,提出一种因果约束策略,对四个角度进行约束,最终得出仅以外环轴角为因变量的控制策略,进而完成全姿态导航解算。结合试验数据和综合仿真结果表明:当外环轴角在不同区域内采取不同的控制策略时,导航解算在全范围内不存在奇异值问题,且最终导航解算得到的四个姿态角误差小于7.2″,具备较高的精度。
-
单位北京航天控制仪器研究所
