申请/专利权人：北京工业大学

申请日：2021-08-01

公开（公告）日：2024-03-29

公开（公告）号：CN113532479B

主分类号：G01C25/00

分类号：G01C25/00

优先权：

专利状态码：有效-授权

法律状态：2024.03.29#授权;2021.11.09#实质审查的生效;2021.10.22#公开

摘要：本发明公开了基于李群滤波的运动状态下捷联惯性导航对准方法，采用李群描述代替传统四元数描述实现对SINS姿态变换的计算，对利用李群和捷联惯导系统的特性构建的新系统进行分析，并根据李群中特殊正交群的性质定义的误差旋转矩阵，建立了基于误差状态的线性初始对准模型，利用凯莱变换恒等地映射到向量空间进行滤波。最后将误差补偿，得到姿态矩阵的最优估计。该方法避免了避免奇异值分解法的大失准角下的奇异点问题和传统四元数方法的非线性近似带来的精度问题；利用误差作为状态量进行估计并对误差进行补偿，状态相关误差得以减小，提高了对准精度。更适合于实际工程应用。

主权项：1.基于李群滤波的捷联惯导系统运动状态初始对准方法，该方法通过下述步骤实现：步骤1：运行SINS捷联惯性导航系统，获取载体所在位置的经度λ、纬度L、当地重力加速度在导航系下的投影gn，采集惯性测量单元IMU中陀螺仪输出的载体系相对于惯性系的旋转角速率信息在载体系的投影和加速度计输出的载体系下载体的加速度信息fb；步骤2：初始对准获得准确的姿态信息，以用一个3×3的正交矩阵来表示，称为姿态矩阵；此姿态矩阵表示的是t时刻从载体坐标系b系到导航坐标系n系的正交旋转矩阵；该正交旋转矩阵符合李群的特殊正交群SOn的性质，构成三维旋转群SO3： 故姿态矩阵用李群中的三维特殊正交群来表示，记作在时间域下对分解，得到三个三维特殊正交群的乘积： 其中R表示三维特殊正交群的元素，表示t时刻n0系到n系的地球运动的旋转矩阵,是初始时刻b0系到n0系的初始旋转矩阵，表示t时刻b系到b0系的载体运动的旋转矩阵；而和通过下列计算求得： 其中和是Δt期间的角速度积分项，所以和通过迭代5和6更新；为了得到还需要估计初始常值姿态矩阵利用IMU和GPS的输出构造出两个向量，并与有如下关系： 将时变特殊正交群中的元素的估计问题转化为时不变特殊正交群中的元素的估计问题；且由于的大小不随时间变化，根据卡尔曼滤波状态估计理论，改写上下角标，并考虑常值漂移、随机漂移和噪声综合影响构成的误差项Δα，将α改写为包含误差项的传感器输出αm＝α+Δα，得到李群描述下的初始对准模型： 运用李群上真值与估计值之间误差旋转矩阵的定义，定义误差状态如下： 将式11带入式10中，原状态转换为误差状态，状态方程为：ηk＝ηk-112由于选择了误差姿态矩阵η作为状态进行估计，所以不再表示状态的估计值，而是新状态η的一个关联值，表示为参考值Rref；根据式11，真值R、参考值Rref和状态η之间的关系重写为:R＝ηRref13式中，R＝ηRref表示真实姿态R等于估计误差状态η乘以参考值Rref；Rref是在离散滤波每个时刻的最后一步进行校正的；R、η和Rref都是SO3中的元素；利用式10中的观测方程，考虑式13，基于李群误差状态η，得到如下观测方程：β＝Rαm-Δα＝ηRrefαm-Δα14重构的基于误差状态的李群对准模型为： 步骤3：基于步骤2，建立代数空间上等效滤波模型，并对ηk进行最优估计，再利用ηk和Rref的关系更新Rref：为了建立代数空间上的等效滤波模型，将误差特殊正交群，同时也是正交矩阵的η用下列凯莱变换进行群空间到代数空间的转换： 是η在误差代数空间上的投影；其中符号·×表示将一个三维向量转换成一个反对称矩阵的运算，运算规则如下： 将式16代入式15，得到误差向量空间中的等效状态方程和观测方程： 对式19进行化简，两边左乘得到： 化简式20，得到误差代数空间的观测方程： 由于表示真值与估计值之间的误差代数估计值，且其高阶次项在短时间过滤间隔△t内变化不大，式21近似为： 综上，代数空间上的等效滤波模型为： 对式23使用乘性卡尔曼滤波器进行滤波，根据式23参数设置如下： 将这些参数带入乘性卡尔曼滤波器中，并综合考虑等效误差代数状态和原误差特殊正交群群状态，得到完整的滤波方程： 在修正误差状态后，姿态参考值Rref仍然保留其上一步的值，因此不再表示最优估计；必须将更新信息从误差状态移动到参考值Rref；故最后考虑Rref的更新并将误差归零： 在滤波的每一步中将作为的估计值并结合式2、式3和式4，即得到每一离散时刻对姿态矩阵的最优估计。

全文数据：

权利要求：

百度查询： 北京工业大学 基于李群乘性卡尔曼滤波的捷联惯导系统运动初始对准方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD