• 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 2019-05-13
  • 银保监会新规剑指大企业多头融资和过度融资 2019-05-12
  • 韩国再提4国联合申办世界杯 中国网友无视:我们自己来 2019-05-11
  • 中国人为什么一定要买房? 2019-05-11
  • 十九大精神进校园:风正扬帆当有为 勇做时代弄潮儿 2019-05-10
  • 粽叶飘香幸福邻里——廊坊市举办“我们的节日·端午”主题活动 2019-05-09
  • 太原设禁鸣路段 设备在测试中 2019-05-09
  • 拜耳医药保健有限公司获第十二届人民企业社会责任奖年度企业奖 2019-05-08
  • “港独”没出路!“梁天琦们”该醒醒了 2019-05-07
  • 陈卫平:中国文化内涵包含三方面 文化复兴表现在其中 2019-05-06
  • 人民日报客户端辟谣:“合成军装照”产品请放心使用 2019-05-05
  • 【十九大·理论新视野】为什么要“建设现代化经济体系”?   2019-05-04
  • 聚焦2017年乌鲁木齐市老城区改造提升工程 2019-05-04
  • 【专家谈】上合组织——构建区域命运共同体的有力实践者 2019-05-03
  • 【华商侃车NO.192】 亲!楼市火爆,别忘了买车位啊! 2019-05-03
    • / 20
    • 下载费用:30 金币  

    亚泰重庆时时彩: 一种基于MEMS/GPS组合系统的信息条件匹配滤波估计方法.pdf

    关 键 词:
    一种 基于 MEMS GPS 组合 系统 信息 条件 匹配 滤波 估计 方法
      专利查询网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。
    摘要
    申请专利号:

    CN201610094618.8

    申请日:

    2016.02.19

    公开号:

    CN105606094A

    公开日:

    2016.05.25

    当前法律状态:

    授权

    有效性:

    有权

    法律详情: 授权|||实质审查的生效IPC(主分类):G01C 21/16申请日:20160219|||公开
    IPC分类号: G01C21/16; G01C25/00; G01S19/47(2010.01)I 主分类号: G01C21/16
    申请人: 北京航天控制仪器研究所
    发明人: 周艳丽; 郭涛; 杨亮; 王盛; 张承亮; 赵龙; 罗强力; 车鹏宇
    地址: 100854 北京142信箱403分箱
    优先权:
    专利代理机构: 中国航天科技专利中心 11009 代理人: 马全亮
    PDF完整版下载: PDF下载
    法律状态
    申请(专利)号:

    CN201610094618.8

    授权公告号:

    ||||||

    法律状态公告日:

    2018.08.21|||2016.06.22|||2016.05.25

    法律状态类型:

    授权|||实质审查的生效|||公开

    摘要

    本发明公开了一种基于MEMS/GPS组合系统的信息条件匹配滤波估计方法,该方法基于MEMS惯性仪表和GPS信号接收等信息建立组合导航物理模型,对系统的传感器输入信息进行实时分析,设计了信息组合判据,对输入信息进行条件筛选和条件匹配,在信息满足组合判据的条件下进行滤波解算,最终获得运动载体准确的速度、姿态和位置信息。

    权利要求书

    1.一种基于MEMS/GPS组合系统的信息条件匹配滤波估计方法,其特征
    在于步骤如下:
    (1)将MEMS/GPS组合系统安装在载体上,在载体运动过程中,MEMS
    惯性仪表实时测量载体坐标系下运动载体的三轴加速度以及三轴角速度值,同
    时获得GPS测量的在地理坐标系下运动载体的三轴速度和位置信息;
    (2)对步骤(1)中所述MEMS惯性仪表测量得到的载体坐标系下的运动
    载体三轴加速度以及三轴角速度值进行条件筛选匹配,剔除测量野值和无效值,
    满足筛选条件情况下进行捷联导航解算;
    (3)对步骤(1)中所述GPS测量得到的地理坐标系下运动载体的三轴速
    度和位置信息进行条件筛选匹配,满足筛选条件的情况下表示GPS测量得到的
    运动载体的三轴速度和位置信息有效,进入步骤(4),否则表示无效,直接进
    行捷联导航解算;
    (4)根据所述载体的运动状态确定进行捷联导航解算或者组合导航解算,
    进行捷联导航解算时,得到载体的导航信息,该导航信息包括速度信息、位置
    信息和姿态信息;
    进行组合导航解算时,得到载体的速度误差、位置误差、姿态误差和MEMS
    惯性仪表误差;
    所述载体的运动状态包括加减速状态、转弯状态和低速运行状态;
    (5)将步骤(4)通过组合导航解算得到载体的速度误差、位置误差、姿
    态误差和MEMS惯性仪表误差,分别设置速度误差修正量、位置误差修正量、
    姿态误差修正量以及仪表误差修正量,对所述MEMS/GPS组合系统进行误差校
    正,最终获得准确的导航信息,完成基于MEMS/GPS组合系统的信息条件匹配
    滤波估计。
    2.根据权利要求1所述的一种基于MEMS/GPS组合系统的信息条件匹配
    滤波估计方法,其特征在于:所述步骤(2)对三轴角速度值进行条件筛选匹配
    通过下述公式进行:
    | Δ G y r o _ x ( k ) - Δ G y r o _ x ( k - 1 ) | < Y u z h i _ G y r o _ x * K _ G y r o _ x | Δ G y r o _ y ( k ) - Δ G y r o _ y ( k - 1 ) | < Y u z h i _ G y r o _ y * K _ G y r o _ y | Δ G y r o _ z ( k ) - Δ G y r o _ z ( k - 1 ) | < Y u z h i _ G y r o _ z * K _ G y r o _ z , ]]>
    其中, { Δ G y r o _ x ( k - 1 ) = [ G y r o _ x ( k - 1 ) - G y r o _ x ( k - 2 ) ] Δ G y r o _ x ( k ) = [ G y r o _ x ( k ) - G y r o _ x ( k - 1 ) ] , ]]>ΔGyro_x(k)为第k时刻
    的X轴角速度值Gyro_x(k)与第k-1时刻的X轴角速度值Gyro_x(k-1)之间的差
    值,ΔGyro_x(k-1)为第k-1时刻的X轴角速度值Gyro_x(k-1)与第k-2时刻的X
    轴角速度值Gyro_x(k-2)之间的差值;
    Δ G y r o _ y ( k - 1 ) = [ G y r o _ y ( k - 1 ) - G y r o _ y ( k - 2 ) ] Δ G y r o _ y ( k ) = [ G y r o _ y ( k ) - G y r o _ y ( k - 1 ) ] , ]]>ΔGyro_y(k)为第k时刻的Y轴
    角速度值Gyro_y(k)与第k-1时刻的Y轴角速度值Gyro_y(k-1)之间的差值,
    ΔGyro_y(k-1)为第k-1时刻的Y轴角速度值Gyro_y(k-1)与第k-2时刻的Y轴角
    速度值Gyro_y(k-2)之间的差值;
    Δ G y r o _ z ( k - 1 ) = [ G y r o _ z ( k - 1 ) - G y r o _ z ( k - 2 ) ] Δ G y r o _ z ( k ) = [ G y r o _ z ( k ) - G y r o _ z ( k - 1 ) ] ; ]]>ΔGyro_z(k)为第k时刻的Z轴角
    速度值Gyro_z(k)与第k-1时刻的Z轴角速度值Gyro_z(k-1)之间的差值,
    ΔGyro_z(k-1)为第k-1时刻的Z轴角速度值Gyro_z(k-1)与第k-2时刻的Z轴角
    速度值Gyro_z(k-2)之间的差值;
    Yuzhi_Gyro_x、Yuzhi_Gyro_y和Yuzhi_Gyro_z为角速度预设阈值,K_Gyro_x、
    K_Gyro_y和K_Gyro_z为角速度比例系数。
    3.根据权利要求1所述的一种基于MEMS/GPS组合系统的信息条件匹配
    滤波估计方法,其特征在于:所述步骤(2)对三轴加速度值进行条件筛选匹配
    通过下述公式进行:
    | Δ A c c _ x ( k ) - Δ A c c _ x ( k - 1 ) | < Y u z h i _ A c c _ x * K _ A c c _ x | Δ A c c _ y ( k ) - Δ A c c _ y ( k - 1 ) | < Y u z h i _ A c c _ y * K _ A c c _ y | Δ A c c _ z ( k ) - Δ A c c _ z ( k - 1 ) | < Y u z h i _ A c c _ z * K _ A c c _ z ]]>
    其中, { Δ A c c _ x ( k - 1 ) = [ A c c _ x ( k - 1 ) - A c c _ x ( k - 2 ) ] Δ A c c _ x ( k ) = [ A c c _ x ( k ) - A c c _ x ( k - 1 ) ] , ]]>ΔAcc_x(k)为第k时刻的X
    轴加速度值Acc_x(k)与第k-1时刻的X轴加速度值Acc_x(k-1)之间的差值,
    ΔAcc_x(k-1)为第k-1时刻的X加角速度值Acc_x(k-1)与第k-2时刻的X轴加速
    度值Acc_x(k-2)之间的差值;
    { Δ A c c _ y ( k - 1 ) = [ A c c _ y ( k - 1 ) - A c c _ y ( k - 2 ) ] Δ A c c _ y ( k ) = [ A c c _ y ( k ) - A c c _ y ( k - 1 ) ] , ]]>ΔAcc_y(k)为第k时刻的Y轴加速
    度值Acc_y(k)与第k-1时刻的Y轴加速度值Acc_y(k-1)之间的差值,
    ΔAcc_y(k-1)为第k-1时刻的Y轴加速度值Acc_y(k-1)与第k-2时刻的Y轴加速
    度值Acc_y(k-2)之间的差值;
    { Δ A c c _ z ( k - 1 ) = [ A c c _ z ( k - 1 ) - A c c _ z ( k - 2 ) ] Δ A c c _ z ( k ) = [ A c c _ z ( k ) - A c c _ z ( k - 1 ) ] , ]]>ΔAcc_z(k)为第k时刻的Z轴加速度
    值Acc_z(k)与第k-1时刻的Z轴加速度值Acc_z(k-1)之间的差值,ΔAcc_z(k-1)为
    第k-1时刻的Z轴加速度值Acc_z(k-1)与第k-2时刻的Z轴加速度值
    Acc_z(k-2)之间的差值;
    Yuzhi_Acc_x、Yuzhi_Acc_y和Yuzhi_Acc_z为加速度预设阈值,K_Acc_x、
    K_Acc_y和K_Acc_z为加速度比例系数。
    4.根据权利要求2所述的一种基于MEMS/GPS组合系统的信息条件匹配
    滤波估计方法,其特征在于:所述角速度预设阈值和角速度比例系数具体为:
    Y u z h i _ G y r o _ x = 5 , K _ G y r o _ x [ 1 , 3 ] Y u z h i _ G y r o _ y = 5 , K _ G y r o _ y [ 1 , 3 ] Y u z h i _ G y r o _ z = 10 , K _ G y r _ z [ 1 , 3 ] . ]]>
    5.根据权利要求3所述的一种基于MEMS/GPS组合系统的信息条件匹配
    滤波估计方法,其特征在于:所述加速度预设阈值和加速度比例系数具体为:
    Y u z h i _ A c c _ x = 5 , K _ A c c _ x [ 0.5 , 2 ] Y u z h i _ A c c _ y = 10 , K _ A c c _ y [ 0.5 , 2 ] Y u z h i _ A c c _ z = 2 , K _ A c c _ z [ 0.5 , 2 ] . ]]>
    6.根据权利要求1所述的一种基于MEMS/GPS组合系统的信息条件匹配
    滤波估计方法,其特征在于:所述步骤(3)对GPS测量得到的地理坐标系下
    运动载体的三轴速度和位置信息进行条件筛选匹配,具体为:
    |ΔLong|≤Yuzhi_Long,Yuzhi_Long=5×10-4
    |ΔLat|≤Yuzhi_Lat,Yuzhi_Lat=5×10-4,
    |ΔHeigh|≤Yuzhi_Heigh,Yuzhi_Heigh=10
    |ΔVe|≤Yuzhi_Ve,Yuzhi_Ve=10
    |ΔVn|≤Yuzhi_Vn,Yuzhi_Vn=10
    |ΔVu|≤Yuzhi_Vu,Yuzhi_Vu=10
    其中, { Δ L o n g = L o n g _ G p s - L o n g _ S i n s Δ L a t = L a t _ G p s - L a t _ S i n s Δ H e i g h = H e i g h _ G p s - H e i g h _ S i n s , Δ V e = V e _ G p s - V e _ S i n s Δ V n = V n _ G p s - V n _ S i n s Δ V u = V u _ G p s - V u _ S i n s , ]]>ΔLong为
    GPS经度测量值与惯导解算的经度值之差,ΔLat为GPS纬度测量值与惯导解算
    的纬度值之差,ΔHeigh为GPS高度测量值与惯导解算的高度值之差,ΔVe为GPS
    东向速度测量值与惯导解算的东向速度值之差,ΔVn为GPS北向速度测量值与
    惯导解算的北向速度值之差,ΔVu为GPS天向速度测量值与惯导解算的天向速
    度值之差。
    7.根据权利要求1所述的一种基于MEMS/GPS组合系统的信息条件匹配
    滤波估计方法,其特征在于:所述步骤(4)根据所述载体的运动状态确定进行
    捷联导航解算或者组合导航解算具体为:
    (7.1)判断载体是否处于加减速状态,如果处于加速或者减速状态,则进
    行捷联导航解算,否则进入步骤(7.2);
    通过载体的前向加速度来判断载体的加减速状态:|Acc_y|≥1m/s^2;
    (7.2)判断载体是否处于转弯状态,如果处于转弯状态,则进行捷联导航
    解算,否则进入步骤(7.3);
    用天向的陀螺来进行弯道检测,|Gyro_z|≥20°/s;
    (7.3)判断载体是否处于低速运行状态,如果处于低速运行状态,则进行
    捷联导航解算,否则进行组合导航解算;
    所述低速运行状态是指载体满足
    8.根据权利要求1所述的一种基于MEMS/GPS组合系统的信息条件匹配
    滤波估计方法,其特征在于:所述步骤(5)中将通过组合导航解算得到载体的
    速度误差、位置误差、姿态误差和MEMS惯性仪表,分别设置速度误差修正量、
    位置误差修正量、姿态误差修正量以及仪表误差修正量,对所述MEMS/GPS
    组合系统进行误差校正,最终获得准确的导航信息,具体为:
    令速度误差修正量等于速度误差值,位置误差修正量等于位置误差值,姿
    态误差修正量为: Δφ x = Δφ x Δφ y = Δφ y Δφ z = P 1 * Δφ z + P 2 * k 0 z * Δ T , ]]>其中,Δφx′、Δφy′和Δφz′为姿态误差
    修正量的三轴分量,Δφx、Δφy和Δφz为通过组合导航解算得到载体的姿态误差三
    轴分量,P1和P2为加权系数且P1+P2=1,k0z为MEMS惯性仪表中陀螺仪的漂移
    误差,ΔT=k,k为当前时刻的值;
    对所述MEMS/GPS组合系统进行误差校正具体为:
    L o n g = L o n g _ S i n s - Δ L o n g _ k l m L a t = L a t _ S i n s - Δ L a t _ k l m H e i g h = H e i g h _ S i n s - Δ H e i g h _ k l m , ]]>
    V e = V e _ S i n s - Δ V e _ k l m V n = V n _ S i n s - Δ V n _ k l m V u = V u _ S i n s - Δ V u _ k l m , ]]>
    C n n = 1 - Δφ z Δφ y Δφ z 1 - Δφ x - Δφ y Δφ x 1 , ]]>
    C b n = C n n C b n , ]]>
    其中,Long为校正后的经度值,Lat为校正后的纬度值,Height为校正后的高度
    值,Ve为校正后的东向速度,Vn为校正后的北向速度,Vu为校正后的天向速度,
    为校正后的姿态矩阵,Long_Sins、Lat_Sins和Heigh_Sins分别为捷联解算获
    得的载体的经度值、纬度值和高度值,Ve_Sins、Vn_Sins和Vu_Sins分别为捷联解
    算获得的载体的东向速度值、北向速度值和天向速度值;ΔLong_klm、ΔLat_klm
    和ΔHeigh_klm分别为位置误差修正量中的经度误差修正量、纬度误差修正量以
    及高度误差修正量;ΔVe_klm、ΔVn_klm和ΔVu_klm分别为速度误差修正量中的东
    向速度误差修正量、北向速度误差修正量以及天向速度误差修正量;Δφx′、Δφy′、
    Δφz′分别为姿态误差修正量中的俯仰角误差修正量、横滚角误差修正量以及偏
    航角误差修正量,为由姿态误差修正量构成的修正矩阵,为捷联解算获得
    的姿态矩阵。

    说明书

    一种基于MEMS/GPS组合系统的信息条件匹配滤波估计方法

    技术领域

    本发明涉及一种组合导航系统的导航参数估计方法,尤其涉及MEMS/GPS
    组合导航系统中的信息条件匹配滤波方法,可用于导航估计领域。

    背景技术

    随着MEMS惯性仪表技术以及军用武器的小型化和智能化发展,MEMS
    体积小,成本低,功耗低等优势越来越明显,基于MEMS的惯性/GPS组合导
    航系统可应用于空地制导武器,如航空制导炸弹,火箭弹、智能炮弹、无人机、
    无人靶机等军用领域,也可用于机器人控制、车载定位定向和微小型船舶系统、
    卫星通信等民用领域。MEMS惯性仪表单独使用,存在随着时间累计误差漂移
    现象,同时由于精度相对低,因此需要和GPS导航系统组合,构成完整的组合
    系统,发挥各自优势,获得准确的导航信息。

    基于kalman的组合滤波技术的成熟也应用于工程实际,算法框架和流程相
    对固定,但是在不同的应用状态下,并不能一概而论,依据不同的载体需要做
    细致的分析和规划。目前大部分工程应用并未完全考虑实际运动过程中的测量
    误差和误差效应,均采用一种解算流程和误差方程通用的思路,因此需要做技
    术改进。

    发明内容

    本发明的技术解决问题:克服现有技术的不足,提供了一种基于MEMS/GPS
    组合系统的信息条件匹配滤波估计方法,该方法可用于不同运动状态的载体测
    量,环境适应性强,将获得的测量信息进行筛选和条件匹配,来判断进行组合
    滤波,获得估计结果,并提高了估计的准确程度。

    本发明的技术解决方案:

    一种基于MEMS/GPS组合系统的信息条件匹配滤波估计方法,步骤如下:

    (1)将MEMS/GPS组合系统安装在载体上,在载体运动过程中,MEMS
    惯性仪表实时测量载体坐标系下运动载体的三轴加速度以及三轴角速度值,同
    时获得GPS测量的在地理坐标系下运动载体的三轴速度和位置信息;

    (2)对步骤(1)中所述MEMS惯性仪表测量得到的载体坐标系下的运动
    载体三轴加速度以及三轴角速度值进行条件筛选匹配,剔除测量野值和无效值,
    满足筛选条件情况下进行捷联导航解算;

    (3)对步骤(1)中所述GPS测量得到的地理坐标系下运动载体的三轴速
    度和位置信息进行条件筛选匹配,满足筛选条件的情况下表示GPS测量得到的
    运动载体的三轴速度和位置信息有效,进入步骤(4),否则表示无效,直接进
    行捷联导航解算;

    (4)根据所述载体的运动状态确定进行捷联导航解算或者组合导航解算,
    进行捷联导航解算时,得到载体的导航信息,该导航信息包括速度信息、位置
    信息和姿态信息;

    进行组合导航解算时,得到载体的速度误差、位置误差、姿态误差和MEMS
    惯性仪表误差;

    所述载体的运动状态包括加减速状态、转弯状态和低速运行状态;

    (5)将步骤(4)通过组合导航解算得到载体的速度误差、位置误差、姿
    态误差和MEMS惯性仪表误差,分别设置速度误差修正量、位置误差修正量、
    姿态误差修正量以及仪表误差修正量,对所述MEMS/GPS组合系统进行误差校
    正,最终获得准确的导航信息,完成基于MEMS/GPS组合系统的信息条件匹配
    滤波估计。

    所述步骤(2)对三轴角速度值进行条件筛选匹配通过下述公式进行:

    | Δ G y r o _ x ( k ) - Δ G y r o _ x ( k - 1 ) | < Y u z h i _ G y r o _ x * K _ G y r o _ x | Δ G y r o _ y ( k ) - Δ G y r o _ y ( k - 1 ) | < Y u z h i _ G y r o _ y * K _ G y r o _ y | Δ G y r o _ z ( k ) - Δ G y r o _ z ( k - 1 ) | < Y u z h i _ G y r o _ z * K _ G y r o _ z , ]]>

    其中, Δ G y r o _ x ( k - 1 ) = [ G y r o _ x ( k - 1 ) - G y r o _ x ( k - 2 ) ] Δ G y r o _ x ( k ) = [ G y r o _ x ( k ) - G y r o _ x ( k - 1 ) ] , ]]>ΔGyro_x(k)为第k时刻
    的X轴角速度值Gyro_x(k)与第k-1时刻的X轴角速度值Gyro_x(k-1)之间的差
    值,ΔGyro_x(k-1)为第k-1时刻的X轴角速度值Gyro_x(k-1)与第k-2时刻的X
    轴角速度值Gyro_x(k-2)之间的差值;

    Δ G y r o _ y ( k - 1 ) = [ G y r o _ y ( k - 1 ) - G y r o _ y ( k - 2 ) ] Δ G y r o _ y ( k ) = [ G y r o _ y ( k ) - G y r o _ y ( k - 1 ) ] , ]]>ΔGyro_y(k)为第k时刻的Y轴
    角速度值Gyro_y(k)与第k-1时刻的Y轴角速度值Gyro_y(k-1)之间的差值,
    ΔGyro_y(k-1)为第k-1时刻的Y轴角速度值Gyro_y(k-1)与第k-2时刻的Y轴角
    速度值Gyro_y(k-2)之间的差值;

    Δ G y r o _ z ( k - 1 ) = [ G y r o _ z ( k - 1 ) - G y r o _ z ( k - 2 ) ] Δ G y r o _ z ( k ) = [ G y r o _ z ( k ) - G y r o _ z ( k - 1 ) ] ; ]]>ΔGyro_z(k)为第k时刻的Z轴角
    速度值Gyro_z(k)与第k-1时刻的Z轴角速度值Gyro_z(k-1)之间的差值,
    ΔGyro_z(k-1)为第k-1时刻的Z轴角速度值Gyro_z(k-1)与第k-2时刻的Z轴角
    速度值Gyro_z(k-2)之间的差值;

    Yuzhi_Gyro_x、Yuzhi_Gyro_y和Yuzhi_Gyro_z为角速度预设阈值,K_Gyro_x、
    K_Gyro_y和K_Gyro_z为角速度比例系数。

    所述步骤(2)对三轴加速度值进行条件筛选匹配通过下述公式进行:

    | Δ A c c _ x ( k ) - Δ A c c _ x ( k - 1 ) | < Y u z h i _ A c c _ x * K _ A c c _ x | Δ A c c _ y ( k ) - Δ A c c _ y ( k - 1 ) | < Y u z h i _ A c c _ y * K _ A c c _ y | Δ A c c _ z ( k ) - Δ A c c _ z ( k - 1 ) | < Y u z h i _ A c c _ z * K _ A c c _ z ]]>

    其中, Δ A c c _ x ( k - 1 ) = [ A c c _ x ( k - 1 ) - A c c _ x ( k - 2 ) ] Δ A c c _ x ( k ) = [ A c c _ x ( k ) - A c c _ x ( k - 1 ) ] , ]]>ΔAcc_x(k)为第k时刻的X
    轴加速度值Acc_x(k)与第k-1时刻的X轴加速度值Acc_x(k-1)之间的差值,
    ΔAcc_x(k-1)为第k-1时刻的X加角速度值Acc_x(k-1)与第k-2时刻的X轴加速
    度值Acc_x(k-2)之间的差值;

    Δ A c c _ y ( k - 1 ) = [ A c c _ y ( k - 1 ) - A c c _ y ( k - 2 ) ] Δ A c c _ y ( k ) = [ A c c _ y ( k ) - A c c _ y ( k - 1 ) ] , ]]>ΔAcc_y(k)为第k时刻的Y轴加速
    度值Acc_y(k)与第k-1时刻的Y轴加速度值Acc_y(k-1)之间的差值,
    ΔAcc_y(k-1)为第k-1时刻的Y轴加速度值Acc_y(k-1)与第k-2时刻的Y轴加速
    度值Acc_y(k-2)之间的差值;

    Δ A c c _ z ( k - 1 ) = [ A c c _ z ( k - 1 ) - A c c _ z ( k - 2 ) ] Δ A c c _ z ( k ) = [ A c c _ z ( k ) - A c c _ z ( k - 1 ) ] , ]]>ΔAcc_z(k)为第k时刻的Z轴加速度
    值Acc_z(k)与第k-1时刻的Z轴加速度值Acc_z(k-1)之间的差值,ΔAcc_z(k-1)为
    第k-1时刻的Z轴加速度值Acc_z(k-1)与第k-2时刻的Z轴加速度值
    Acc_z(k-2)之间的差值;

    Yuzhi_Acc_x、Yuzhi_Acc_y和Yuzhi_Acc_z为加速度预设阈值,K_Acc_x、
    K_Acc_y和K_Acc_z为加速度比例系数。

    所述角速度预设阈值和角速度比例系数具体为:

    Y u z h i _ G y r o _ x = 5 , K _ G y r o _ x [ 1 , 3 ] Y u z h i _ G y r o _ y = 5 , K _ G y r o _ y [ 1 , 3 ] Y u z h i _ G y r o _ z = 10 , K _ G y r o _ z [ 1 , 3 ] . ]]>

    所述加速度预设阈值和加速度比例系数具体为:

    Y u z h i _ A c c _ x = 5 , K _ A c c _ x [ 0.5 , 2 ] Y u z h i _ A c c _ y = 10 , K _ A c c _ y [ 0.5 , 2 ] Y u z h i _ A c c _ z = 2 , K _ A c c _ z [ 0.5 , 2 ] . ]]>

    所述步骤(3)对GPS测量得到的地理坐标系下运动载体的三轴速度和位
    置信息进行条件筛选匹配,具体为:

    | Δ L o n g | Y u z h i _ L o n g , Y u z h i _ L o n g = 5 × 10 - 4 | Δ L a t | Y u z h i _ L a t , Y u z h i _ L a t = 5 × 10 - 4 | Δ H e i g h | Y u z h i _ H e i g h , Y u z h i _ H e i g h = 10 , ]]>

    | Δ V e | Y u z h i _ V e , Y u z h i _ V e = 10 | Δ V n | Y u z h i _ V n , Y u z h i _ V n = 10 | Δ V u | Y u z h i _ V u , Y u z h i _ V u = 10 ]]>

    其中, Δ L o n g = L o n g _ G p s - L o n g _ S i n s Δ L a t = L a t _ G p s - L a t _ S i n s Δ H e i g h = H e i g h _ G p s - H e i g h _ S i n s , Δ V e = V e _ G p s - V e _ S i n s Δ V n = V n _ G p s - V n _ S i n s Δ V u = V u _ G p s - V u _ S i n s , ]]>ΔLong为
    GPS经度测量值与惯导解算的经度值之差,ΔLat为GPS纬度测量值与惯导解算
    的纬度值之差,ΔHeigh为GPS高度测量值与惯导解算的高度值之差,ΔVe为GPS
    东向速度测量值与惯导解算的东向速度值之差,ΔVn为GPS北向速度测量值与
    惯导解算的北向速度值之差,ΔVu为GPS天向速度测量值与惯导解算的天向速
    度值之差。

    所述步骤(4)根据所述载体的运动状态确定进行捷联导航解算或者组合导
    航解算具体为:

    (7.1)判断载体是否处于加减速状态,如果处于加速或者减速状态,则进
    行捷联导航解算,否则进入步骤(7.2);

    通过载体的前向加速度来判断载体的加减速状态:|Acc_y|≥1m/s^2;

    (7.2)判断载体是否处于转弯状态,如果处于转弯状态,则进行捷联导航
    解算,否则进入步骤(7.3);

    用天向的陀螺来进行弯道检测,|Gyro_z|≥20°/s;

    (7.3)判断载体是否处于低速运行状态,如果处于低速运行状态,则进行
    捷联导航解算,否则进行组合导航解算;

    所述低速运行状态是指载体满足

    所述步骤(5)中将通过组合导航解算得到载体的速度误差、位置误差、姿
    态误差和MEMS惯性仪表,分别设置速度误差修正量、位置误差修正量、姿态
    误差修正量以及仪表误差修正量,对所述MEMS/GPS组合系统进行误差校正,
    最终获得准确的导航信息,具体为:

    令速度误差修正量等于速度误差值,位置误差修正量等于位置误差值,姿
    态误差修正量为:其中,Δφx′、Δφy′和Δφz′为姿态误差
    修正量的三轴分量,Δφx、Δφy和Δφz为通过组合导航解算得到载体的姿态误差三
    轴分量,P1和P2为加权系数且P1+P2=1,k0z为MEMS惯性仪表中陀螺仪的漂移
    误差,ΔT=k,k为当前时刻的值;

    对所述MEMS/GPS组合系统进行误差校正具体为:

    L o n g = L o n g _ S i n s - Δ L o n g _ k l m L a t = L a t _ S i n s - Δ L a t _ k l m H e i g h = H e i g h _ S i n s - Δ H e i g h _ k l m , ]]>

    V e = V e _ S i n s - Δ V e _ k l m V n = V n _ S i n s - Δ V n _ k l m V u = V u _ S i n s - Δ V u _ k l m , ]]>

    C n n = 1 - Δφ z Δφ y Δφ z 1 - Δφ x - Δφ y Δφ x 1 , ]]>

    C b n = C n n C b n , ]]>

    其中,Long为校正后的经度值,Lat为校正后的纬度值,Height为校正后的
    高度值,Ve为校正后的东向速度,Vn为校正后的北向速度,Vu为校正后的天向
    速度,为校正后的姿态矩阵,Long_Sins、Lat_Sins和Heigh_Sins分别为捷联
    解算获得的载体的经度值、纬度值和高度值,Ve_Sins、Vn_Sins和Vu_Sins分别为
    捷联解算获得的载体的东向速度值、北向速度值和天向速度值;ΔLong_klm、
    ΔLat_klm和ΔHeigh_klm分别为位置误差修正量中的经度误差修正量、纬度误差修
    正量以及高度误差修正量;ΔVe_klm、ΔVn_klm和ΔVu_klm分别为速度误差修正量
    中的东向速度误差修正量、北向速度误差修正量以及天向速度误差修正量;Δφx′、
    Δφy′、Δφz′分别为姿态误差修正量中的俯仰角误差修正量、横滚角误差修正量以
    及偏航角误差修正量,为由姿态误差修正量构成的修正矩阵,为捷联解算
    获得的姿态矩阵。

    本发明与现有方法相比的优点在于:

    (1)以往方法使用直接滤波估计,并不对当前时刻的运动状态和测量误
    差进行估计,这样会引入误差,甚至发散。本发明采用测量值对当前的运动状
    态进行预估,同时也对当前时刻的测量信息进行误差判断,依据实际动态试验
    的数据设定了滤波的条件,判断当前时刻是否满足滤波条件,满足则进入信息
    融合,不满足则进入纯解算或者纯卫星导航状态;

    (2)本发明通过分析载体运动状态,考虑了不同运动过程中存在的误差
    放大等效应,设定了滤波匹配条件,使得kalman滤波适用于任何动态下都能准
    确的估计出载体的位置、速度和姿态信息;

    (3)应用本发明可以保证任意时刻的估计误差均能达到最小状态,长时
    间可以对试验中的测量信息进行更详尽的分析,而以往的方法仅能粗略的获得
    当前的导航值,并不能时刻保持较高精度。

    附图说明

    图1为本发明方法流程图;

    图2为信息条件筛选流程图;

    图3为位置经纬度对比图;

    图4为东向速度对比图;

    图5为北向速度对比图;

    图6为俯仰角对比图;

    图7为横滚角对比图;

    图8为偏航角对比图;

    具体实施方式

    在惯性和GPS卫星组合时,采用kalman信息融合算法将二者紧密结合是
    常见的方法,由于实际的数学模型线性化,未能完全描述载体的运动状态,直
    接进行组合会造成数学模型的非线性误差以及引入的测量误差使算法发散,并
    不能保证实际系统的完整可靠,同时非线性滤波方法的运算量大,在DSP等数
    字平台上实现有困难。针对这些问题,本发明提出了将信息进行筛选衡量,条
    件匹配的信息融合滤波算法,通过实际搭载的平台进行了试验,获得了高精度
    的导航信息。

    本发明方法流程图如图1所示,其步骤如下:

    (1)将MEMS/GPS组合系统即MEMS惯性仪表和GPS??樽槌傻牡己?br />系统安装在载体上,在载体运动过程中,MEMS惯性仪表实时测量载体坐标系
    下运动载体的三轴加速度以及三轴角速度值,载体坐标系的原点为载体质心,
    X轴指向载体右侧,Y轴指向载体前向,Z轴满足右手定则垂直向上;同时获
    得GPS测量的在地理坐标系下运动载体的三轴速度和位置信息,地理坐标系是
    指向经纬度表示地面点位的球面坐标系,X、Y和Z分别指向东、北、天。

    (2)当前时刻的MEMS惯性仪表的测量信息存在野值错误帧等情况,因
    此不能直接作为输入量进行导航解算即通过测量的加速度和角速度值进行积分
    得到导航信息,根据载体的运动特性,对运动状态进行了条件预估以及运动阈
    值设计。条件预估采用相邻两时刻的测量值,作为此时刻运动状态估计的依据。

    对步骤(1)中所述MEMS惯性仪表测量得到的载体坐标系下的运动载体
    三轴加速度以及三轴角速度值进行条件筛选匹配,剔除测量野值和无效值,满
    足筛选条件情况下进行捷联导航解算;

    对三轴角速度值进行条件筛选匹配通过下述公式进行:

    | Δ G y r o _ x ( k ) - Δ G y r o _ x ( k - 1 ) | < Y u z h i _ G y r o _ x * K _ G y r o _ x | Δ G y r o _ y ( k ) - Δ G y r o _ y ( k - 1 ) | < Y u z h i _ G y r o _ y * K _ G y r o _ y | Δ G y r o _ z ( k ) - Δ G y r o _ z ( k - 1 ) | < Y u z h i _ G y r o _ z * K _ G y r o _ z , ]]>

    其中, Δ G y r o _ x ( k - 1 ) = [ G y r o _ x ( k - 1 ) - G y r o _ x ( k - 2 ) ] Δ G y r o _ x ( k ) = [ G y r o _ x ( k ) - G y r o _ x ( k - 1 ) ] , ]]>ΔGyro_x(k)为第k时刻
    的X轴角速度值Gyro_x(k)与第k-1时刻的X轴角速度值Gyro_x(k-1)之间的差
    值,ΔGyro_x(k-1)为第k-1时刻的X轴角速度值Gyro_x(k-1)与第k-2时刻的X
    轴角速度值Gyro_x(k-2)之间的差值;

    Δ G y r o _ y ( k - 1 ) = [ G y r o _ y ( k - 1 ) - G y r o _ y ( k - 2 ) ] Δ G y r o _ y ( k ) = [ G y r o _ y ( k ) - G y r o _ y ( k - 1 ) ] , ]]>ΔGyro_y(k)为第k时刻的Y轴
    角速度值Gyro_y(k)与第k-1时刻的Y轴角速度值Gyro_y(k-1)之间的差值,
    ΔGyro_y(k-1)为第k-1时刻的Y轴角速度值Gyro_y(k-1)与第k-2时刻的Y轴角
    速度值Gyro_y(k-2)之间的差值;

    Δ G y r o _ z ( k - 1 ) = [ G y r o _ z ( k - 1 ) - G y r o _ z ( k - 2 ) ] Δ G y r o _ z ( k ) = [ G y r o _ z ( k ) - G y r o _ z ( k - 1 ) ] , ]]>ΔGyro_z(k)为第k时刻的Z轴角
    速度值Gyro_z(k)与第k-1时刻的Z轴角速度值Gyro_z(k-1)之间的差值,
    ΔGyro_z(k-1)为第k-1时刻的Z轴角速度值Gyro_z(k-1)与第k-2时刻的Z轴角
    速度值Gyro_z(k-2)之间的差值;

    Yuzhi_Gyro_x、Yuzhi_Gyro_y和Yuzhi_Gyro_z为角速度预设阈值,K_Gyro_x、
    K_Gyro_y和K_Gyro_z为角速度比例系数。

    对三轴加速度值进行条件筛选匹配通过下述公式进行:

    | Δ A c c _ x ( k ) - Δ A c c _ x ( k - 1 ) | < Y u z h i _ A c c _ x * K _ A c c _ x | Δ A c c _ y ( k ) - Δ A c c _ y ( k - 1 ) | < Y u z h i _ A c c _ y * K _ A c c _ y | Δ A c c _ z ( k ) - Δ A c c _ z ( k - 1 ) | < Y u z h i _ A c c _ z * K _ A c c _ z ]]>

    其中, Δ A c c _ x ( k - 1 ) = [ A c c _ x ( k - 1 ) - A c c _ x ( k - 2 ) ] Δ A c c _ x ( k ) = [ A c c _ x ( k ) - A c c _ x ( k - 1 ) ] , ]]>ΔAcc_x(k)为第k时刻的X
    轴加速度值Acc_x(k)与第k-1时刻的X轴加速度值Acc_x(k-1)之间的差值,
    ΔAcc_x(k-1)为第k-1时刻的X加角速度值Acc_x(k-1)与第k-2时刻的X轴加速
    度值Acc_x(k-2)之间的差值;

    Δ A c c _ y ( k - 1 ) = [ A c c _ y ( k - 1 ) - A c c _ y ( k - 2 ) ] Δ A c c _ y ( k ) = [ A c c _ y ( k ) - A c c _ y ( k - 1 ) ] , ]]>ΔAcc_y(k)为第k时刻的Y轴加速
    度值Acc_y(k)与第k-1时刻的Y轴加速度值Acc_y(k-1)之间的差值,
    ΔAcc_y(k-1)为第k-1时刻的Y轴加速度值Acc_y(k-1)与第k-2时刻的Y轴加速
    度值Acc_y(k-2)之间的差值;

    Δ A c c _ z ( k - 1 ) = [ A c c _ z ( k - 1 ) - A c c _ z ( k - 2 ) ] Δ A c c _ z ( k ) = [ A c c _ z ( k ) - A c c _ z ( k - 1 ) ] , ]]>ΔAcc_z(k)为第k时刻的Z轴加速度
    值Acc_z(k)与第k-1时刻的Z轴加速度值Acc_z(k-1)之间的差值,ΔAcc_z(k-1)为
    第k-1时刻的Z轴加速度值Acc_z(k-1)与第k-2时刻的Z轴加速度值
    Acc_z(k-2)之间的差值;

    Yuzhi_Acc_x、Yuzhi_Acc_y和Yuzhi_Acc_z为加速度预设阈值,K_Acc_x、
    K_Acc_y和K_Acc_z为加速度比例系数。

    以上公式主要是获得三轴陀螺前后两时刻测量差值,差值与设计的阈值
    Yuzhi和比例系数的积即判定条件进行比较,若前后两时刻的差值小于判定条
    件,则认为此时刻陀螺的测量数据有效,有效数据进入导航解算。车载系统,
    俯仰角和横滚角变化不大,航向角则在转弯和掉头等路况中变化大,所述角速
    度预设阈值和角速度比例系数具体为:

    Y u z h i _ G y r o _ x = 5 , K _ G y r o _ x [ 1 , 3 ] Y u z h i _ G y r o _ y = 5 , K _ G y r o _ y [ 1 , 3 ] Y u z h i _ G y r o _ z = 10 , K _ G y r o _ z [ 1 , 3 ] . ]]>

    同样如车载系统,车辆运动体现在加减速,因此Y轴的加速度计的变化量
    大于其他两轴,依据经验数据所述加速度预设阈值和加速度比例系数具体为:

    Y u z h i _ A c c _ x = 5 , K _ A c c _ x [ 0.5 , 2 ] Y u z h i _ A c c _ y = 10 , K _ A c c _ y [ 0.5 , 2 ] Y u z h i _ A c c _ z = 2 , K _ A c c _ z [ 0.5 , 2 ] . ]]>

    (3)对步骤(1)中所述GPS测量得到的地理坐标系下运动载体的三轴速
    度和位置信息进行条件筛选匹配,剔除无效信息,满足筛选条件的情况下表示
    GPS测量得到的运动载体的三轴速度和位置信息有效,进入步骤(4),否则表
    示无效,直接进行捷联导航解算,信息条件筛选流程图如图2所示

    在卫星信号失锁时,输出数据无效,在重捕获时,数据的有效性也需进行
    判断,同时冷启动和热启动因此也需要对GPS数据进行有效性判断,GPS仅用
    位置和速度作为观测量,因此仅对此参数进行阈值判断。主要思想是,当前获
    得的GPS值与惯导解算的值进行比较,在实时修正下,两者差别不大,当GPS
    满足以下条件时,可与惯性导航的结果进行信息融合。

    对GPS测量得到的地理坐标系下运动载体的三轴速度和位置信息进行条件
    筛选匹配,具体为:

    | Δ L o n g | Y u z h i _ L o n g , Y u z h i _ L o n g = 5 × 10 - 4 | Δ L a t | Y u z h i _ L a t , Y u z h i _ L a t = 5 × 10 - 4 | Δ H e i g h | Y u z h i _ H e i g h , Y u z h i _ H e i g h = 10 , ]]>

    | Δ V e | Y u z h i _ V e , Y u z h i _ V e = 10 | Δ V n | Y u z h i _ V n , Y u z h i _ V n = 10 | Δ V u | Y u z h i _ V u , Y u z h i _ V u = 10 ]]>

    其中, Δ L o n g = L o n g _ G p s - L o n g _ S i n s Δ L a t = L a t _ G p s - L a t _ S i n s Δ H e i g h = H e i g h _ G p s - H e i g h _ S i n s , Δ V e = V e _ G p s - V e _ S i n s Δ V n = V n _ G p s - V n _ S i n s Δ V u = V u _ G p s - V u _ S i n s , ]]>ΔLong为
    GPS经度测量值与惯导解算的经度值之差,ΔLat为GPS纬度测量值与惯导解算
    的纬度值之差,ΔHeigh为GPS高度测量值与惯导解算的高度值之差,ΔVe为GPS
    东向速度测量值与惯导解算的东向速度值之差,ΔVn为GPS北向速度测量值与
    惯导解算的北向速度值之差,ΔVu为GPS天向速度测量值与惯导解算的天向速
    度值之差。

    (4)通过获得的输入信息对载体的运动状态转弯、加速、减速等进行判断;
    通过GPS卫星导航信息与IMU捷联解算的导航值设置kalman(一种数据融合
    算法)信息匹配条件,满足筛选条件的进入组合导航即将捷联导航数据和GPS
    导航的数据通过kalman滤波算法进行数据融合,估计出导航误差,包括速度误
    差、位置误差和姿态误差。

    根据所述载体的运动状态确定进行捷联导航解算或者组合导航解算,进行
    捷联导航解算时,得到载体的导航信息,该导航信息包括速度信息、位置信息
    和姿态信息;

    进行组合导航解算时,得到载体的速度误差、位置误差、姿态误差和MEMS
    惯性仪表误差;

    考虑到观测信息在转弯、加减速频繁和低速的情况下,定位定速精度相应
    减小,为避免kalman解算时引入更多的误差信息,因此在观测信息精度损失的
    情况下不进行组合,反之其他状态下进行组合。

    所述载体的运动状态确定进行捷联导航解算或者组合导航解算具体为:

    (4.1)判断载体是否处于加减速状态,如果处于加速或者减速状态,则进
    行捷联导航解算,否则进入步骤(4.2);

    通过载体的前向加速度来判断载体的加减速状态:|Acc_y|≥1m/s^2;

    (4.2)判断载体是否处于转弯状态,如果处于转弯状态,则进行捷联导航
    解算,否则进入步骤(4.3);

    用天向的陀螺来进行弯道检测,|Gyro_z|≥20°/s;

    (4.3)判断载体是否处于低速运行状态,如果处于低速运行状态,则进行
    捷联导航解算,否则进行组合导航解算;

    所述低速运行状态是指载体满足

    GPS失锁后,重捕获能力的快速性会影响到组合算法的精度,本方法采用
    时间计时器来判断,载体是否处于“GPS卫星信号的重捕获合的过渡状态”,如
    果是,则不进行kalman组合导航,具体判断阈值如下所示:

    Cnt_flag≥3

    其中Cnt_flag用于计算载体从GPS卫星信号的重捕获合的过渡状态的标识计
    数,经过长时间的纯捷联解算,重新进入组合状态时,误差很大,此时的修正
    会引入很大的过渡误差,因此头三次不进入kalman,采用简单直接取代的方式,
    之后进入kalman修正。

    标识计数根据GPS重捕获的快速性来确定,其他参数值也根据实际情况而
    定,本方法的参数均为多次跑车试验的经验值。

    (5)将步骤(4)通过组合导航解算得到载体的速度误差、位置误差、姿
    态误差和MEMS惯性仪表误差,分别设置速度误差修正量、位置误差修正量、
    姿态误差修正量以及仪表误差修正量,对所述MEMS/GPS组合系统进行误差校
    正,最终获得准确的导航信息,完成基于MEMS/GPS组合系统的信息条件匹配
    滤波估计。

    由于陀螺仪存在漂移误差,本方法结合Kalman估计的角度误差和仪表的
    漂移误差,对角度修正量进行比例支配,P1和P2为比例系数,根据陀螺的误差
    特性设计。

    由于建立的Kalman误差模型,航向角误差不可观,因此误差估计不准,
    但是实际上陀螺的漂移是随时间积累而客观存在的,因此需要进行补偿,求得
    两次修正时间内,航向陀螺仪的漂移量,与Kalman估计的航向误差角进行比
    例结合,获得最终的误差角,具体如下:

    令速度误差修正量等于速度误差值,位置误差修正量等于位置误差值,姿
    态误差修正量为: Δφ x = Δφ x Δφ y = Δφ y Δφ z = P 1 * Δφ z + P 2 * k 0 z * Δ T , ]]>其中,Δφx′、Δφy′和Δφz′为姿态误差
    修正量的三轴分量,Δφx、Δφy和Δφz为通过组合导航解算得到载体的姿态误差三
    轴分量,P1和P2为加权系数且P1+P2=1,k0z为MEMS惯性仪表中陀螺仪的漂移
    误差,ΔT=k。

    估计的速度和位置误差均可观测,因此可以通过GPS的观测量获得当前时
    刻纯捷联导航解算的误差值,采用输出校正方式,如下述公式所示,直接减去
    误差量,求得准确的速度和位置。

    对所述MEMS/GPS组合系统进行误差校正具体为:

    L o n g = L o n g _ S i n s - Δ L o n g _ k l m L a t = L a t _ S i n s - Δ L a t _ k l m H e i g h = H e i g h _ S i n s - Δ H e i g h _ k l m , ]]>

    V e = V e _ S i n s - Δ V e _ k l m V n = V n _ S i n s - Δ V n _ k l m V u = V u _ S i n s - Δ V u _ k l m , ]]>

    俯仰角和横滚角可观测,因此直接采用估计的状态量参与姿态修正。修正
    矩阵如下:

    C n n = 1 - Δφ z Δφ y Δφ z 1 - Δφ x - Δφ y Δφ x 1 , ]]>

    C b n = C n n C b n , ]]>

    其中,Long为校正后的经度值,Lat为校正后的纬度值,Height为校正后的
    高度值,Ve为校正后的东向速度,Vn为校正后的北向速度,Vu为校正后的天向
    速度,为校正后的姿态矩阵,Long_Sins、Lat_Sins和Heigh_Sins分别为捷联
    解算获得的载体的经度值、纬度值和高度值,Ve_Sins、Vn_Sins和Vu_Sins分别为
    捷联解算获得的载体的东向速度值、北向速度值和天向速度值;ΔLong_klm、
    ΔLat_klm和ΔHeigh_klm分别为位置误差修正量中的经度误差修正量、纬度误差修
    正量以及高度误差修正量;ΔVe_klm、ΔVn_klm和ΔVu_klm分别为速度误差修正量
    中的东向速度误差修正量、北向速度误差修正量以及天向速度误差修正量;Δφx′、
    Δφy′、Δφz′分别为姿态误差修正量中的俯仰角误差修正量、横滚角误差修正量以
    及偏航角误差修正量,为由姿态误差修正量构成的修正矩阵,为捷联解算
    获得的姿态矩阵。

    实例1:将此方法在MEMS/GPS惯组平台上进行了跑车试验,并与高精度
    的激光惯组的导航参数进行比较,获得最终的导航误差。MEMS惯性陀螺的精
    度为60°/h,加速度计的精度为10mg,依据此MEMS仪表的特性,设定了陀
    螺和加表的数据有效比例值和航向角误差的加权值如下:

    K _ G y r o _ x = 1.0 K _ G y r o _ y = 1.0 K _ G y r o _ z = 2.0 , K _ A c c _ x = 1.0 K _ A c c _ y = 2.0 K _ A c c _ z = 1.0 , P 1 = 0.2 P 2 = 0.8 ]]>

    表1导航误差统计表

    序号
    导航参数
    误差值
    单位
    1
    俯仰角
    0.09
    °
    2
    横滚角
    0.08
    °
    3
    偏航角
    2.76
    °
    4
    东向速度
    0.26
    m/s
    5
    北向速度
    0.29
    m/s
    6
    东向距离
    4.81
    m
    7
    北向距离
    3.66
    m

    图3~图8为跑车试验结果图,本方法的结果与高精度惯组的导航结果进行
    比较,其中图3位置经纬度对比图,横坐标表示纬度,单位“°”,纵坐标表示
    经度,单位“°”;图4为东向速度对比图,横坐标表示时间,单位秒“s”,纵
    坐标表示北向速度,单位为“m/s”;图5为北向速度对比图,横坐标表示时间,
    单位秒“s”,纵坐标表示北向速度,单位为“m/s”;图6为俯仰角对比图横坐
    标表示时间,单位秒“°”,纵坐标表示北向速度,单位为“m/s”;图7为横滚
    角对比图,横坐标表示时间,单位秒“s”,纵坐标表示北向速度,单位为“°”;
    图8为偏航角对比图,横坐标表示时间,单位秒“s”,纵坐标表示北向速度,
    单位为“°”。跑车试验全程曲线趋势一致,证明了本发明方法的可靠性。

    以上表格为此方法的跑车试验的导航误差值,姿态角误差在0.1°以下,偏
    航角误差在5°以下,速度误差在0.5m/s以内,位置误差在5.0m以内,由于惯
    性导航在垂直方向发散,因此天向的速度和位置信息不参与计算。从表格中可
    看出数据精度高,充分证明了本发明方法在实际使用过程中达到了比较好的试
    验效果,验证了此方法可行性。

    本发明未详细描述内容为本领域技术人员公知技术。

    关于本文
    本文标题:一种基于MEMS/GPS组合系统的信息条件匹配滤波估计方法.pdf
    链接地址://www.4mum.com.cn/p-5886361.html
    关于我们 - 网站声明 - 网站地图 - 资源地图 - 友情链接 - 网站客服 - 联系我们

    [email protected] 2017-2018 www.4mum.com.cn网站版权所有
    经营许可证编号:粤ICP备17046363号-1 
     


    收起
    展开
  • 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 2019-05-13
  • 银保监会新规剑指大企业多头融资和过度融资 2019-05-12
  • 韩国再提4国联合申办世界杯 中国网友无视:我们自己来 2019-05-11
  • 中国人为什么一定要买房? 2019-05-11
  • 十九大精神进校园:风正扬帆当有为 勇做时代弄潮儿 2019-05-10
  • 粽叶飘香幸福邻里——廊坊市举办“我们的节日·端午”主题活动 2019-05-09
  • 太原设禁鸣路段 设备在测试中 2019-05-09
  • 拜耳医药保健有限公司获第十二届人民企业社会责任奖年度企业奖 2019-05-08
  • “港独”没出路!“梁天琦们”该醒醒了 2019-05-07
  • 陈卫平:中国文化内涵包含三方面 文化复兴表现在其中 2019-05-06
  • 人民日报客户端辟谣:“合成军装照”产品请放心使用 2019-05-05
  • 【十九大·理论新视野】为什么要“建设现代化经济体系”?   2019-05-04
  • 聚焦2017年乌鲁木齐市老城区改造提升工程 2019-05-04
  • 【专家谈】上合组织——构建区域命运共同体的有力实践者 2019-05-03
  • 【华商侃车NO.192】 亲!楼市火爆,别忘了买车位啊! 2019-05-03
  • 江西多乐彩一定牛 同期开奖历史记录 星辉国际首页 北京赛车pk10微信群 超级大乐透规则 口袋彩票网址 2元彩票南粤36选7基本走势图 贵州十一选五基本走势 新疆18选7开奖基本走势 极速飞艇官方开奖结果 云南时时彩材 股票吧 后三九码计划 捕鱼游戏王 急速赛车手高清 双色球红球尾数子墨