一种低成本双天线GNSS/AHRS组合测姿方法技术

本发明专利技术涉及一种低成本双天线GNSS/AHRS组合测姿方法，属于卫星定位与导航技术领域。该方法基于低成本GNSS模块以及9轴AHRS传感器，利用GNSS单频伪距与载波相位观测值，实时解算载体的位置与速度信息，结合AHRS加速度、角速度以及磁传感器数据，采用Kalman滤波技术实时估计载体的姿态信息，并基于虚拟观测值的最小二乘平差，实时解算载波相位的模糊度，修正载体的航向。本方法能够实时矫正AHRS传感器系统性偏差，并提高系统的稳定性与可靠性。

【技术实现步骤摘要】

本专利技术属于卫星定位与导航
，涉及一种低成本双天线GNSS/AHRS组合测姿方法。
技术介绍
全球卫星导航系统(GNSS)是我国自主建设的全球卫星导航系统，能够为地球表面和近地空间的广大用户提供全天时、全天候、高精度的定位、导航和授时服务，已广泛应用于国防、海陆空交通运输、测绘、移动通信、电力、电子金融、精细农业和减灾救灾等领域，是拓展人类活动和促进社会发展的重要空间基础设施。GNSS精密测向技术是全球卫星导航系统提供精密位置服务的关键技术之一，目前已广泛应用于驾考、精准农业、无人机等机械控制。它利用GNSS测向技术，以载体上的两个接收机采集的载波相位和伪距数据作为主要观测值来进行差分解算，并估计载波相位的整周模糊度，可以实时获得高精度的航向信息，极大的提高了作业效率，降低作业成本。但是基于目前的GNSS测向产品一般基于采用双频方案，其硬件成本相对较高，从而限制了其应用范围以及产业化推广。
技术实现思路
有鉴于此，本专利技术的目的在于提供一种低成本双天线GNSS/AHRS组合测姿方法，该方法能够实时矫正AHRS传感器系统性偏差，并提高系统的稳定性与可靠性。为达到上述目的，本专利技术提供如下技术方案：一种低成本双天线GNSS/AHRS组合测姿方法，该方法基于低成本GNSS模块以及9轴AHRS传感器，利用GNSS单频伪距与载波相位观测值，实时解算载体的位置与速度信息，结合AHRS加速度、角速度以及磁传感器数据，采用Kalman滤波技术实时估计载体的姿态信息，并基于虚拟观测值的最小二乘平差，实时解算载波相位的模糊度，修正载体的航向。进一步，该方法具体包括以下步骤：步骤一：采用单点定位估计主天线位置；原始的伪距观测值为：其中，为原始的伪距观测值，ρs为接收机到卫星的距离(包含误差源，如相对论、地球固体潮、卫星相位中心、卫星硬件延迟等)，tr，g为接收机钟差，g表示不同得卫星导航系统，Is为第一频段载波的电离层延迟，τs为对流层延迟，ε表示伪距的观测噪声；利用模型改正对流层，电离层误差影响，则观测方程可以表示为：对上式线性化，采用最小二乘法估计即可估计接收机位置；步骤二：原始的多普勒观测值估计主天线速度；原始的多普勒观测值为：其中，为原始的伪距观测值，λg为卫星导航系统对应的载波相位波长，为接收机到卫星的距离变化率，为接收机钟差漂移，为卫星钟差漂移，为第一频段载波的电离层延迟变化，为对流层延迟变化，∈表示多普勒观测噪声；对距离变化率展开可得：式中vs为卫星的速度，vr为接收机速度，Is为卫星到接收机的方向矢量；则可得：式中Gs为观测系数矩阵，则采用最小二乘解算即可获得速度信息；步骤三：基于Kalman滤波技术AHRS姿态解算；基于步骤一与步骤二获得的位置与速度，以及AHRS提供的加速度、角速度、磁强度数据，建立GNSS/AHRS融合Kalman滤波方程：状态方程与过程方程如下：Xk＝φXk-1+Γwk-1zk＝HXk+vk采用Kalman滤波技术实时估计载体的姿态信息；步骤四：基线约束模糊度解算；基于步骤三解算的三维姿态信息以及已知的基线长度，实时解算基线分量：式中l为两个天线的基线长度，γ为俯仰角，ε为偏航角，为当地东北天坐标系基线分量；利用解算的基线分量，基于虚拟观测值建立双差载波相位与伪距观测方程为：式为双差伪距观测值，为双差载波相位观测值，A为观测值系数矩阵，m＝(e，n，u)T，b为载波相位整周模糊度矢量；采用最小二乘技术，即可计算模糊度浮点解及其方差协方差阵采用LAMBDA方法解算模糊度，获得模糊度的固定解；式中b为整数模糊度候选矢量，为最优模糊度解算结果；步骤五：固定模糊度更新姿态信息；采用经典的Ratio检验方法，如果模糊度通过检验，则更新基线向量：式中为基线向量与模糊度的协方差，为浮点解基线向量，为固定解基线向量；计算更新后的航向与俯仰信息：利用更新后的航向信息修正磁传感器的地磁航向，获得地理北指向。本专利技术的有益效果在于：本专利技术提供的一种低成本双天线GNSS/AHRS组合测姿方法基于AHRS实时解算三维姿态信息，利用虚拟观测值的最小二乘方法，实时解算模糊度浮点解，实现稳健的高精度GNSS测向；该方法能够实时矫正AHRS传感器系统性偏差，并提高系统的稳定性与可靠性。附图说明为了使本专利技术的目的、技术方案和有益效果更加清楚，本专利技术提供如下附图进行说明：图1为本专利技术所述方法流程图。具体实施方式下面将结合附图，对本专利技术的优选实施例进行详细的描述。图1为本专利技术所述方法流程图，如图所示，本专利技术提供的低成本双天线GNSS/AHRS测向方法具体包括以下步骤：步骤一：采用单点定位估计主天线位置；原始的伪距观测值为：其中，为原始的伪距观测值，ρs为接收机到卫星的距离(包含误差源，如相对论、地球固体潮、卫星相位中心、卫星硬件延迟等)，tr，g为接收机钟差，g表示不同得卫星导航系统，Is为第一频段载波的电离层延迟，τs为对流层延迟，ε表示伪距的观测噪声；利用模型改正对流层，电离层误差影响，则观测方程可以表示为：对上式线性化，采用最小二乘法估计即可估计接收机位置。步骤二：原始的多普勒观测值估计主天线速度；原始的多普勒观测值为：其中，为原始的伪距观测值，λg为卫星导航系统对应的载波相位波长，为接收机到卫星的距离变化率，为接收机钟差漂移，为卫星钟差漂移，为第一频段载波的电离层延迟变化，为对流层延迟变化，∈表示多普勒观测噪声；对距离变化率展开可得：式中vs为卫星的速度，vr为接收机速度，Is为卫星到接收机的方向矢量。则可得：式中Gs为观测系数矩阵，则采用最小二乘解算即可获得速度信息。步骤三：建立AHRSKalman滤波模型；忽略导航坐标系相对于惯性坐标系和导航坐标系相对于地球坐标系的旋转加速度影响，加速度计与陀螺仪的测量方程为：式中ωm＝[ωmxωmyωmz]T为载体坐标系陀螺仪测量值；式中am＝[amxamyamz]T为载体坐标系加速度计测量值；式中ω＝[ωxωyωz]T为载体坐标系实际旋转角速度；式中a＝[axayaz]T为载体坐标系实际加速度；式中wω，wa分别为陀螺仪与加速度计的测量噪声；式中bω＝[bωxbωybωz]T为陀螺仪的零偏；式中为载体坐标系到地固系转换矩阵；式中g＝[0Og]T为北东地重力分量；选取状态向量：其中P＝[PnPePd]T为地固坐标系北东地坐标；V＝[VnVeVd]T为地固坐标系北东地速度；q＝[q0q1q2q3]T为四元素；bω＝[bωxbωybωz]T为陀螺仪偏差。然后建立系统的状态方程为：式中：式中wb为随机游走过程噪声。对状态方程线性化可得：式中：A＝[O3×3I3×3]FVq0＝2(q0amx-q3amy+q2amz)FVq1＝2(q1amx+q2amy+q3amz)FVq2＝2(-q2amx+q1amy+q0amz)FVq3＝2(-q3amx-q0amy+q1)对系统偏差求导：建立系统的观测方程为：Kalman滤波的观测量y包含三维位置、速度与磁强度数据。对观测方程线性化：式中：HBq0＝2(q0Bex+q3Bey-q2Bez)HBq1＝2(q1Bex+q2Bey+q3Bez)HBq2＝2(-q2Bex+q1Bey-q0Bez)HBq3＝2(-q3Bex+q0B本文档来自技高网...

【技术保护点】
一种低成本双天线GNSS/AHRS组合测姿方法，其特征在于：该方法基于低成本GNSS模块以及9轴AHRS传感器，利用GNSS单频伪距与载波相位观测值，实时解算载体的位置与速度信息，结合AHRS加速度、角速度以及磁传感器数据，采用Kalman滤波技术实时估计载体的姿态信息，并基于虚拟观测值的最小二乘平差，实时解算载波相位的模糊度，修正载体的航向。

【技术特征摘要】
1.一种低成本双天线GNSS/AHRS组合测姿方法，其特征在于：该方法基于低成本GNSS模块以及9轴AHRS传感器，利用GNSS单频伪距与载波相位观测值，实时解算载体的位置与速度信息，结合AHRS加速度、角速度以及磁传感器数据，采用Kalman滤波技术实时估计载体的姿态信息，并基于虚拟观测值的最小二乘平差，实时解算载波相位的模糊度，修正载体的航向。2.根据权利要求1所述的一种低成本双天线GNSS/AHRS组合测姿方法，其特征在于：该方法包括以下步骤：步骤一：采用单点定位估计主天线位置；原始的伪距观测值为：Pgs=ρs+tr,g+Is+τs+ϵ]]>其中，为原始的伪距观测值，ρs为接收机到卫星的距离，tr，g为接收机钟差，g表示不同得卫星导航系统，Is为第一频段载波的电离层延迟，τs为对流层延迟，ε表示伪距的观测噪声；利用模型改正对流层，电离层误差影响，则观测方程可以表示为：Pgs=(xs-x)2+(ys-y)2+(zs-z)2+tr,g]]>对上式线性化，采用最小二乘法估计即可估计接收机位置；步骤二：原始的多普勒观测值估计主天线速度；原始的多普勒观测值为：λgDgs=ρ·s+t·r,g-t·s+I·s+τ·s+∈]]>其中，为原始的伪距观测值，λg为卫星导航系统对应的载波相位波长，为接收机到卫星的距离变化率，为接收机钟差漂移，为卫星钟差漂移，为第一频段载被的电离层延迟变化，为对流层延迟变化，∈表示多普勒观测噪声；对距离变化率展开可得：Dgs=(vs-vr)·Is+t·r,g-t·s+∈]]>式中vs为卫星的速度，vr为接收机速度，Is为卫星到接收机的方向矢量；则可得：Dgs+t·s-vsIs=Gsvrt·r,g+∈]]>式中Gs为观测系数矩阵，则采用最...

【专利技术属性】
技术研发人员：祖晖，王少飞，李敏，陈新海，王博思，于兴旺，
申请(专利权)人：招商局重庆交通科研设计院有限公司，中国科学院重庆绿色智能技术研究院，
类型：发明
国别省市：重庆;50