基于卫星导航接收机的GNSS和MIMU组合导航航向角估计方法技术

一种基于卫星导航接收机的GNSS和MIMU组合导航航向角估计方法，其步骤为：（1）利用卫星导航接收机获取可见卫星星历信息、接收机与可见卫星间的相对速度、相对加速度矢量和载体位置、速度信息，计算得到载体加速度矢量；（2）建立SINS在地心地固坐标系中的比力测量方程，根据卫星导航接收机测量得到的载体加速度矢量和MIMU中加速度计的测量值，采用动态调平计算水平姿态角；（3）根据比力测量方程，利用卫星导航接收机测量得到的加速度矢量、加速度计的测量值、计算得到的水平姿态角、速度矢量和当地重力矢量，求解得到航向角信息。本发明专利技术具有原理简单、处理速度快、精度高、计算量小、自主性强等优点。

【技术实现步骤摘要】
基于卫星导航接收机的GNSS和MIMU组合导航航向角估计方法
本专利技术主要涉及到组合导航系统领域，特指一种适用于航空、航天等高动态条件下的GNSS和MIMU组合导航的航向角估计方法。
技术介绍
全球卫星导航系统GNSS（GlobalNavigationSatelliteSystem）具有全天候、连续的、实时的精密三维导航与定位能力，在个人定位服务、气象预报、道路交通、铁路交通、海运和水运、航空运输、应急救援以及武器制导等民用和军用领域极具应用价值；但缺点是动态性能较差、易受电磁干扰、卫星信号易被遮挡等。最成熟、常用的GNSS系统是美国的全球定位系统GPS（GlobalPositioningSystem）。捷联惯性导航系统SINS（StrapdownInertialNavigationSystem）是一种既不依赖于外部信息，又不发射信息的自主式导航系统，具有隐蔽性好、抗干扰能力强等优点，缺点是导航误差随时间累积。由微惯性测量单元MIMU（MEMSbasedInertialMeasurementUnits）构成的SINS由于具有成本低、全固态、可靠性高、抗冲击性好、体积小、功耗低等优势，成为近二十多年来惯性
的研究热点。将GNSS接收机与MIMU进行组合可以达到取长补短的效果，即可以充分利用MIMU短期精度高、不受外界干扰和卫星导航长期精度高的优点，克服MIMU长期精度低和卫星导航系统动态性能较差、易受干扰的缺点，进而在精度和可靠性方面可以获得比单独使用任何一种导航设备都优良的性能。众所周知，SINS进行导航解算前需要对位置、速度、姿态角进行初始化，其中对于姿态角的初始化过程称为“对准”。对准一般分为自对准和传递对准两类，高精度SINS才能实现自对准，低精度SINS一般采用传递对准。传递对准指在运动平台上利用较高精度的捷联惯性导航系统（称为主惯导）信息实现较低精度的捷联惯性导航系统（称为子惯导）初始对准的过程。传递对准作为低精度捷联惯性导航系统工作中的一个重要步骤，其精度和时间直接制约低精度捷联惯性导航系统的性能，因此也对整个系统的综合导航性能有着重要影响。在GNSS/MIMU组合导航系统应用过程中，一般采用传递对准的方法实现导航系统航向角的确定。但是，传递对准需要实时得到主惯导或基准系统的导航信息，难以满足航空、航天日益迫切的高性价比等应用要求。
技术实现思路
本专利技术要解决的技术问题就在于：针对现有技术存在的技术问题，本专利技术提供一种原理简单、处理速度快、精度高、计算量小、自主性强的基于卫星导航接收机的GNSS和MIMU组合导航航向角估计方法。为解决上述技术问题，本专利技术采用以下技术方案：一种基于卫星导航接收机的GNSS和MIMU组合导航航向角估计方法，其步骤为：（1）利用卫星导航接收机获取可见卫星星历信息、接收机与可见卫星间的相对速度、相对加速度矢量和载体位置、速度信息，计算得到载体加速度矢量；（2）建立SINS在地心地固坐标系中的比力测量方程，根据卫星导航接收机测量得到的载体加速度矢量和MIMU中加速度计的测量值，采用动态调平计算水平姿态角；（3）根据比力测量方程，利用卫星导航接收机测量得到的加速度矢量、加速度计的测量值、计算得到的水平姿态角、速度矢量和当地重力矢量，求解得到航向角信息。作为本专利技术的进一步改进：所述步骤（1）中的载体加速度矢量ar是由卫星导航接收机的输出信息计算得到，计算式为：其中，vs为当前卫星的速度，来源于星历信息；as为当前卫星的加速度，根据卫星速度得到；为接收机和卫星之间的相对位置单位矢量和相对位置的模，根据二者的位置确定；vr为接收机输出的载体速度；分别为相对位置变率和相对位置变化的加速度，c为光速，fL为卫星信号载波频率，fd、分别为多普勒频移和多普勒变化率，由接收机载波锁相环路输出。作为本专利技术的进一步改进：所述步骤（2）中采用动态调平计算滚动角φ和俯仰角θ的计算式为：其中，fx为X轴加速度计的测量值，fy为Y轴加速度计的测量值，ax为加速度矢量ar在X轴方向的分量，ay为加速度矢量ar在Y轴方向的分量，g为当地重力值。作为本专利技术的进一步改进：所述步骤（3）中SINS在地心地固坐标系中加速度矢量ar的测量方程为：其中，fb为MIMU中三轴加速度计的测量值，ωe为地球自转角速度，Ve为接收机在地心地固坐标系中的速度矢量，ge为ECEF系中的正常重力加速度矢量，为载体坐标系到ECEF系的方向余弦阵。与现有技术相比，本专利技术的优点在于：本专利技术属于自对准的技术范畴，其利用GNSS接收机测量的加速度值，建立加速度矢量的计算方程，结合SINS动态调平得到的水平姿态角，利用比力测量方程求解得到航向角。本专利技术的方法避免了采用传递对准实现航向角求解的难点，不需要主惯导信息，具有原理简单、处理速度快、高精度、计算量小的优点。附图说明图1是本专利技术方法的流程示意图。图2是本专利技术在具体应用实例中的框架原理示意图。具体实施方式以下将结合说明书附图和具体实施例对本专利技术做进一步详细说明。如图1和图2所示，本专利技术的基于卫星导航接收机的GNSS和MIMU组合导航航向角估计方法，其步骤为：（1）基于卫星导航接收机获取可见卫星星历信息、接收机与可见卫星间的相对速度、相对加速度矢量和载体位置、速度信息，求解出载体加速度矢量；（2）根据卫星导航接收机测量得到的载体加速度矢量和MIMU中加速度计的测量值（即：比力），采用动态调平计算水平姿态角；（3）根据水平姿态角和加速度计测量值，利用比力方程，求解载体航向角。结合具体应用实例，本专利技术的具体流程为：1.卫星导航接收机获取可见卫星星历信息、接收机与可见卫星间的相对速度、相对加速度矢量和载体位置、速度信息，求解出载体加速度矢量；所述求解载体加速度矢量，由下式（1）实现：其中，vs为当前卫星的速度，来源于卫星星历信息；as为当前卫星的加速度，可根据卫星速度得到；为接收机和卫星之间的相对位置大小和相对位置的单位矢量，可根据二者的位置确定；vr为接收机输出的载体速度；分别为卫星与载体之间的相对速度和相对加速度。所述卫星星历信息包括卫星的位置Rs和速度vs，对速度进行差分可得到卫星的运动加速度as。所述接收机与可见卫星间的相对速度，为接收机与可见卫星间距离的变化率，可根据下式（2）得到：其中c、fL分别为光速和卫星信号载波频率，均为固定常数，fd为多普勒频移，是卫星接收机提供的观测量。所本文档来自技高网...

【技术保护点】
一种基于卫星导航接收机的GNSS和MIMU组合导航航向角估计方法，其特征在于，步骤为：（1）利用卫星导航接收机获取可见卫星星历信息、接收机与可见卫星间的相对速度、相对加速度矢量和载体位置、速度信息，计算得到载体加速度矢量；（2）建立SINS在地心地固坐标系中的比力测量方程，根据卫星导航接收机测量得到的载体加速度矢量和MIMU中加速度计的测量值，采用动态调平计算水平姿态角；（3）根据比力测量方程，利用卫星导航接收机测量得到的加速度矢量、加速度计的测量值、计算得到的水平姿态角、速度矢量和当地重力矢量，求解得到航向角信息。

【技术特征摘要】
1.一种基于卫星导航接收机的GNSS和MIMU组合导航航向角估计方法，其特征在于，步骤为：(1)利用卫星导航接收机获取可见卫星星历信息、接收机与可见卫星间的相对速度、相对加速度矢量和载体位置、速度信息，计算得到载体加速度矢量；(2)建立SINS在地心地固坐标系中的比力测量方程，根据卫星导航接收机测量得到的载体加速度矢量和MIMU中加速度计的测量值，采用动态调平计算水平姿态角；(3)根据比力测量方程，利用卫星导航接收机测量得到的加速度矢量、加速度计的测量值、计算得到的水平姿态角、速度矢量和当地重力矢量，求解得到航向角信息；所述步骤(2)中采用动态调平计算滚动角φ和俯仰角θ的计算式为：其中，fx为X轴加速度计的测量值，fy为Y轴加速度计的测量值，ax为加速度矢量ar在X轴方向的分量，ay为加速度矢量ar在Y轴方向的分量，g为当地重力值。2.根据权利要求1所述的基于卫星导航接收机的GNSS和MIMU组合导航航向角估计方法，其特征在于，所述步骤(1)...

【专利技术属性】
技术研发人员：罗兵，何晓峰，唐康华，胡小平，王安成，江明明，吴美平，张开东，练军想，刘伟，
申请(专利权)人：中国人民解放军国防科学技术大学，
类型：发明
国别省市：