基于扩展克雷洛夫角的全姿态导航解算方法

摘要：

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

关键词：四元数;克雷洛夫角;扩展克雷洛夫角;双欧拉角;全姿态导航

所属期刊栏目：29

分类号：V249(航空仪表、航空设备、飞行控制与导航)

资助基金：国防科技创新特区项目18-163-15-LZ-001-002-10

在线出版日期：2022-01-17（万方平台首次上网日期，不代表论文的发表时间）

页数：共10页

页码：594-603