一种基于旋转MEMSIMU的车载导航系统定位误差减小的方法

本发明涉及导航定位，尤其涉及一种基于旋转mems imu的车载导航系统定位误差减小的方法。

背景技术：

1、全球卫星导航系(global navigation satellite system，gnss)信号受到阻挡或失效的环境下，惯性导航系统(inertial navigation system，ins)成为一种重要的定位解决方案。然而，ins存在误差累积的问题，这可能导致定位精度下降。ins的可观测性与车辆的机动性有着紧密的联系，即使采用辅助ins的方法，即利用里程计、激光测距仪、相机等传感器输出的信息作为外部观测，低动态下的车辆也会造成ins的误差累积。

2、从可观测性的角度可以解释为惯性系统中存在不可观测的误差状态量，或者多个误差状态量耦合在一起导致其可观测度低。利用pwcs可观测性分析方法，对非旋转系统与绕x轴旋转的系统的误差状态量做可观测性分析表明，绕x轴旋转系统中可观测的误差状态量以及可独立观测的误差状态量明显多余非旋转系统，其中航向角误差在以上系统中都是无法被直接观测的，但影响航向角最重要的因素也就是z轴的陀螺仪零偏在绕x轴系统中变得可观测，因此，本次方案的提出就是为了解决传统组合导航中航向角误差累积的问题。

3、需要说明的是，在上述背景技术部分公开的信息只用于加强对本公开的背景的理解，因此可以包括不构成对本领域普通技术人员已知的现有技术的信息。

技术实现思路

1、本发明的目的在于克服现有技术的缺点，提供了一种基于旋转mems imu的车载导航系统定位误差减小的方法，缓解了基于mems imu的惯性系统在低动态下存在的误差累积，提高了定位精度。

2、本发明的目的通过以下技术方案来实现：一种基于旋转mems imu的车载导航系统定位误差减小的方法，所述定位误差消除方法包括：

3、利用绕x轴旋转系统中mems imu模块输出的数据经过传感器系和车载平台系的旋转矩阵转换到载体系下的imu数据，通过惯性解算得到经度λ、纬度l和高度h导航系n系下的速度vn，以及导航系与载体系的旋转矩阵

4、当gnss当前数据的时间大于等于前一时刻mems imu数据到来的时间且小于当前时刻mems imu数据到来的时间(观测量有效)，利用gnss输出的地速作为观测量，通过扩展卡尔曼滤波将惯性解算的信息与观测量信息进行信息融合输出l、λ、h、vn、

5、当gnss当前数据的时间小于前一时刻mems imu数据到来的时间或者大于当前时刻mems imu数据到来的时刻则(观测量无效)进行误差状态传播。

6、计算所述旋转矩阵包括：旋转平台初始位置与地平线平行，旋转速度为n°/s，旋转开始时间与mems imu开始记录数据的时间一致，通过记录的时间计算mems imu模块旋转的角度，利用该角度计算出传感器系s系到车载平台系b系的旋转矩阵

7、所述惯性解算包括以下内容：

8、根据导航系下的速度微分公式进行速度与位置更新，其中，fb表示加速度计测量的比力，表示导航系和载体系的旋转矩阵，为载体运动和地球自转引起的哥氏加速度，gn是重力加速度，为需要扣除的有害加速度，获得运载体在导航系下的几何运动加速度，对加速度积分依次可得到速度，再次积分可以得到位置；

9、姿态更新：选取东-北-天地理坐标系作为捷联惯导系统的导航参考坐标系，记为n，则以n系作为参考坐标系的姿态微分方程为表示b系相对于n系的角速度，其中矩阵表示载体系b系相较于导航系n系的旋转矩阵；

10、对姿态微分方程进行变换为其中，为陀螺仪输出的角速度，为陀螺仪输出的载体系b系相对于惯性i系的角速度，为陀螺仪输出的载体系b系相对于惯性i系的角速度，表示n系相对于i系的旋转角度，它包括地球自转引起的导航系的旋转以及惯导系统在地球表面移动因地球表面弯曲引起的n系的旋转，即其中，rmh＝rm+h，rnh＝rn+h，ωie为地球自转角速率，l和h分别是地理纬度和高度，对进行积分可以得到旋转矩阵最后计算出姿态角，经过惯性解算后输出l、λ、h、vn、

11、所述误差状态传播包括：。

12、更新每时刻的误差状态转移矩阵其中，frv，fvr和fvε子阵分别表示位置误差、速度误差和姿态误差之间的扰动关系，βf和βω为加速度计和陀螺仪零偏相关的系数。

13、所述扩展卡尔曼滤波包括：

14、将15维误差状态方程表示为15维误差状态量包括导航系下位置误差(东向、北向、天向)、导航系下的速度误差(东向、北向、天向)、导航系下姿态误差(俯仰、横滚、航向)、传感器系下陀螺仪零偏三轴零偏、传感器系下加速度三轴零偏；xk表示上一时刻的状态量，wk表示上一时刻的系统噪声，扩展卡尔曼滤波的观测模型表示为hk表示观测矩阵，vk表示零均值噪声序列，rk表示噪声协方差矩阵；

15、通过系统的误差状态转移矩阵φk,k-1和当前状态估计值预测下一时刻的系统状态

16、通过系统的误差状态转移矩阵φk,k-1、当前状态估计误差协方差矩阵pk-1(+)，以及噪声驱动矩阵gk-1和系统噪声协方差矩阵qk-1，预测下一时刻的状态估计误差协方差矩阵表示过程噪声；

17、通过状态估计误差协方差矩阵pk和测量噪声协方差矩阵rk的值来确定卡尔曼滤波增益kk表示卡尔曼滤波增益；

18、通过预测状态和测量更新后的状态估计值，得到当前时刻的最优状态估计值

19、通过预测状态估计误差协方差矩阵和测量更新后的状态估计误差协方差矩阵，计算当前时刻的最优状态估计误差协方差矩阵pk(+)＝(i-kkhk)pk(-)，i表示15维单位矩阵；

20、重复上述步骤直到得到最接近于真实值的状态协方差矩阵p。

21、本发明具有以下优点：

22、1、一种基于旋转mems imu的车载导航系统定位误差减小的方法，使用旋转的方法提高系统的可观测性，并结合卡尔曼滤波实现导航定位误差的消除，通过本方法既不会引入车辆的线性运动但是增强了测量模块的机动性，从而有效改善了惯性导航系统误差状态量的可观测性，最终有效提高了车载导航的定位精度，提高定位精度。

23、2、本方法在价格低廉的车载平台上得到了验证且定位精度有大幅度的提高，充分说明该方法具备两方面的优势：其一是方案的有效性；其二是实现该方案成本的低廉。

24、3、该方案对gnss信号中断时低动态下的载体应用场景具有参考价值。

技术特征：

1.一种基于旋转memsimu的车载导航系统定位误差减小的方法，其特征在于：所述车载导航系统定位误差减小的方法包括：

2.根据权利要求1所述的一种基于旋转memsimu的车载导航系统定位误差减小的方法，其特征在于：计算所述旋转矩阵包括：旋转平台初始位置与地平线平行，旋转速度为n°/s，旋转开始时间与memsimu开始记录数据的时间一致，通过记录的时间计算mems imu模块旋转的角度，利用该角度计算出传感器系s系到车载平台系b系的旋转矩阵

3.根据权利要求1所述的一种基于旋转memsimu的车载导航系统定位误差减小的方法，其特征在于：所述惯性解算包括以下内容：

4.根据权利要求1所述的一种基于旋转memsimu的车载导航系统定位误差减小的方法，其特征在于：所述误差状态传播包括：。

5.根据权利要求4所述的一种基于旋转memsimu的车载导航系统定位误差减小的方法，其特征在于：所述扩展卡尔曼滤波包括：

技术总结
本发明涉及一种基于旋转MEMS IMU的车载导航系统定位误差减小的方法，包括：利用绕X轴旋转系统中MEMS IMU模块输出的数据进行惯性解算得到经度、纬度和速度，以及旋转矩阵；当GNSS当前数据的时间大于等于前一时刻MEMS IMU数据到来的时间且小于当前时刻MEMS IMU数据到来的时间(观测量有效)，利用GNSS输出的地速作为观测量，通过扩展卡尔曼滤波将惯性解算的信息与观测量信息进行信息融合输出L、λ、h、v<supgt;n</supgt;、当GNSS当前数据的时间小于前一时刻MEMS IMU数据到来的时间或者大于当前时刻MEMS IMU数据到来的时刻则(观测量无效)进行误差状态传播。本发明使用旋转的方法提高系统的可观测性，达到导航定位精度提高的目的。

技术研发人员：杜爽,杨文慧,邓斯琪,赵鑫,甘章怡
受保护的技术使用者：电子科技大学
技术研发日：
技术公布日：2024/1/16