专利名称：一种卫星惯性导航方法和设备的制作方法
技术领域：
本发明涉及导航设备和导航方法，特别是涉及ー种卫星惯性导航设备及其导航方法。
背景技术：
导航设备广泛应用在道路机动车上。导航设备一般根据卫星定位信号和电子地图为机动车提供起点至目的地的路线指引。在高楼密集区、隧道等这类环境，由于存在信号多路径干渉及信号被遮挡较大，卫星信号会变得很弱甚至接收不到卫星信号，因此称这些地方为卫星定位盲区。在卫星定位盲区内导航设备因接收不到卫星信号而无法定位导航。
发明内容
基于此，有必要提供一种在卫星定位盲区内可继续提供导航信息的卫星惯性导航设备及其导航方法。ー种高精度卫星惯性导航方法，包括步骤
利用卫星定位模块获得载体的卫星定位信息；
利用惯性测量组件获得载体的速度信息和相对转动角速度；
根据所述速度信息和相对转动角速度计算所述载体相对前ー计算周期获得的卫星惯性导航结果的相对位移矢量；
所述卫星惯性导航方法还包括步骤
利用卫星定位模块获得反映卫星定位质量的数据；
根据所述反映卫星定位质量的数据信息计算卫星信号接收质量评估因子；
建立扩展卡尔曼滤波系统，根据所述评估因子融合所述卫星定位信息和相对位移矢量，获得卫星惯性导航结果；以及
根据所述卫星惯性导航结果和电子地图数据在显示器上显示电子地图及导航图像。在优选的实施例中，所述的卫星惯性导航方法还包括在所述评估因子大于或等于预设值时，根据所述卫星惯性导航结果和所述相对位移矢量计算所述惯性测量组件的校正參数的步骤。在优选的实施例中，所述卫星定位模块可选自北斗卫星定位模块，GPS卫星定位模块、欧洲伽利略卫星定位模块、北斗-GPS双模卫星定位模块、北斗-伽利略双模卫星定位模块、北斗-GPS-伽利略三模卫星定位模块；所述反映卫星定位质量的数据至少包括卫星信号的可用性电文信息和卫星信号強度信息。在优选的实施例中，所述建立扩展卡尔曼滤波系统，根据所述评估因子融合所述卫星定位信息和相对位移矢量的步骤包括
建立第一扩展卡尔曼滤波子系统，根据所述评估因子和卫星定位信息计算出第一局部状态向量估计及第一局部误差协方差矩阵；
建立第二扩展卡尔曼滤波子系统，根据所述评估因子和相对位移矢量计算出第二局部状态向量估计及第ニ局部误差协方差矩阵；
根据所述第一局部状态向量估计、第一局部误差协方差矩阵、第二局部状态向量估计及第ニ局部误差协方差矩阵计算全局误差协方差矩阵和全局状态向量，并根据全局状态向量生成卫星惯性导航結果；以及
将所述全局误差协方差矩阵和全局状态向量反馈给第一和第二扩展卡尔曼滤波子系统，其中所述全局误差协方差矩阵在反馈时根据下ー轮迭代的所述评估因子按比例放大反馈。在优选的实施例中，所述建立第一扩展卡尔曼滤波子系统的步骤包括 设定状态向量
权利要求
1.ー种卫星惯性导航方法，包括步骤 利用卫星定位模块获得载体的卫星定位信息； 利用惯性测量组件获得载体的速度信息和相对转动角速度； 根据所述速度信息和相对转动角速度计算所述载体相对前ー计算周期获得的卫星惯性导航结果的相对位移矢量； 其特征在于，还包括步骤 利用卫星定位模块获得反映卫星定位质量的数据； 根据所述反映卫星定位质量的数据信息计算卫星信号接收质量评估因子； 建立扩展卡尔曼滤波系统，根据所述评估因子融合所述卫星定位信息和相对位移矢量，获得卫星惯性导航結果；以及 根据所述卫星惯性导航结果和电子地图数据在显示器上显示电子地图及导航图像。
2.根据权利要求I所述的卫星惯性导航方法，其特征在于，还包括在所述评估因子大于或等于预设值时，根据所述卫星惯性导航结果和所述相对位移矢量计算所述惯性测量组件的校正參数的步骤。
3.根据权利要求I所述的卫星惯性导航方法，其特征在于，所述卫星定位模块选自北斗卫星定位模块，GPS卫星定位模块、欧洲伽利略卫星定位模块、北斗-GPS双模卫星定位模块、北斗-伽利略双模卫星定位模块、北斗-GPS-伽利略三模卫星定位模块等定位模块；所述反映卫星定位质量的数据至少包括卫星信号的可用性电文信息和卫星信号強度信息。
4.根据权利要求I所述的卫星惯性导航方法，其特征在于，所述建立扩展卡尔曼滤波系统，根据所述评估因子融合所述卫星定位信息和相对位移矢量的步骤包括 建立第一扩展卡尔曼滤波子系统，根据所述评估因子和卫星定位信息计算出第一局部状态向量估计及第一局部误差协方差矩阵； 建立第二扩展卡尔曼滤波子系统，根据所述评估因子和相对位移矢量计算出第二局部状态向量估计及第ニ局部误差协方差矩阵； 根据所述第一局部状态向量估计、第一局部误差协方差矩阵、第二局部状态向量估计及第ニ局部误差协方差矩阵计算全局误差协方差矩阵和全局状态向量，并根据全局状态向量生成卫星惯性导航结果；以及 将所述全局误差协方差矩阵和全局状态向量反馈给第一和第二扩展卡尔曼滤波子系统，其中所述全局误差协方差矩阵在反馈时根据所述评估因子按比例放大反馈。
5.根据权利要求4所述的卫星惯性导航方法，其特征在于，所述建立第一扩展卡尔曼滤波子系统的步骤包括 设定状态向量K Sf Vk 、惯性变换矩阵J1 =Jfog(為.4」.'和观测向量Z1 =|e wf,其中ff和H分别表示地球上西东走向的位置坐标及南北走向的位置坐标，其中观测向量み与状态向量；1'间的转换用函数Z1 = I2l(JT1)来表示，则导出\对；的偏导的雅可比矩阵丑！=はQ Q J Q p|； I—-J 设定往前递推状态向量=A^A(k}; 设定往如递推误差协方差矩阵巧::::0=為. ぎ4. +01 , Qi表不第一扩展卡尔曼滤波子系统的过程激励噪声协方差矩阵；计算卡尔曼增益
6.根据权利要求4所述的卫星惯性导航方法，其特征在于，所述建立第二扩展卡尔曼滤波子系统的步骤包括 设定状态向量I:= K- ai n i:r;iらす、惯性变换矩阵為=為J*和观测向量= [^.￡2 SffJ,其中^和it分别表示地球上西东走向的位置坐标及南北走向的位Fi r r^2置坐标,為
7.根据权利要求4所述的卫星惯性导航方法，其特征在于，所述计算全局误差协方差矩阵和全局状态向量的方法包括 计算全局误差协方差矩阵其
8.根据权利要求4至7项中任一项所述的卫星惯性导航方法，其特征在于，所述全局状态向量直接等价反馈给第一和第二扩展卡尔曼滤波子系统。
9.根据权利要求4至7项中任一项所述的卫星惯性导航方法，其特征在干，反馈给第一和第二扩展卡尔曼滤波子系统的误差协方差矩阵分别为
10.根据权利要求I所述的卫星惯性导航方法，其特征在于，所述利用惯性测量组件获得载体的速度信息和相对转动角速度的同时还获得所述载体的倒车信号。
11.一种卫星惯性导航设备，包括用于获得载体的卫星定位信息的卫星定位模块、用于获得载体的速度信息和相对转动角速度的惯性测量组件、处理器模块、存储器和显示器，其中处理器模块用于根据所述速度信息和相对转动角速度得到载体的相对位移矢量，并根据所述卫星定位信息和相对位移矢量获得卫星惯性导航结果并在显示器上显示导航结果，其特征在于 所述卫星定位模块可获得反映卫星定位质量的数据、根据所述反映卫星定位质量的数据计算卫星信号接收质量评估因子、建立扩展卡尔曼滤波系统，井根据所述评估因子基于所述扩展卡尔曼滤波系统融合所述卫星定位信息和相对位移矢量，从而获得卫星惯性导航结果。
12.根据权利要求11所述的卫星惯性导航设备，其特征在于，所述卫星定位模块选自北斗卫星定位模块，GPS卫星定位模块、欧洲伽利略卫星定位模块、北斗-GPS双模卫星定位模块、北斗-伽利略双模卫星定位模块、北斗-GPS-伽利略三模卫星定位模块等定位模块；所述反映卫星定位质量的数据至少包括卫星信号的可用性电文信息和卫星信号強度信息。
13.根据权利要求11所述的卫星惯性导航设备，其特征在于，所述惯性测量组件包括陀螺仪、速度信号模块和倒车信号模块。
全文摘要
本发明涉及卫星惯性导航方法，包括步骤利用卫星定位模块获得载体的卫星定位信息及反映卫星定位质量的数据；利用惯性测量组件获得载体的相对位移矢量；根据反映卫星定位质量的数据计算卫星信号接收质量评估因子；建立扩展卡尔曼滤波系统，根据评估因子融合所述卫星定位信息和相对位移矢量，获得卫星惯性导航结果；以及根据卫星惯性导航结果和电子地图数据在显示器上显示电子地图及导航图像。利用本发明卫星惯性导航方法能使卫星惯性导航设备在卫星信号质量差或卫星定位盲区根据卫星信号接收质量评估因子实现对惯性测量组件信号的惯性推算的部分采纳或全采纳，因而可保证导航信息的持续更新和定位信息的准确度。
文档编号G01C21/16GK102645222SQ201210102079
公开日2012年8月22日 申请日期2012年4月10日 优先权日2012年4月10日
发明者杜孙正 申请人:惠州市德赛西威汽车电子有限公司