CN114895340A - 双天线gnss/ins组合导航系统的定位方法和装置 - Google Patents
双天线gnss/ins组合导航系统的定位方法和装置 Download PDFInfo
- Publication number
- CN114895340A CN114895340A CN202210362719.4A CN202210362719A CN114895340A CN 114895340 A CN114895340 A CN 114895340A CN 202210362719 A CN202210362719 A CN 202210362719A CN 114895340 A CN114895340 A CN 114895340A
- Authority
- CN
- China
- Prior art keywords
- ins
- antenna
- angle
- gnss
- attitude
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本申请实施例公开了一种双天线GNSS/INS组合导航系统的定位方法和装置。所述方法包括:在对惯性导航系统INS进行初始化过程中,获取双天线全球定位系统GNSS的航向角初始值;确定以惯性导航单元IMU为中心O的IMU坐标系中双天线矢量与IMU坐标系的OX轴的夹角;利用所述夹角修正双天线GNSS的航向角初始值,得到INS的航向角初始值;在利用INS的航向角初始值完成INS的初始化后,执行组合导航系统的定位操作。
Description
技术领域
本申请实施例涉及信息处理领域,尤指一种双天线GNSS/INS组合导航系统的定位方法。
背景技术
随着GNSS(Global Navigation Satellite System,全球卫星定位系统)的发展,已经形成了全球包括GPS(Global Positioning System,全球定位系统)、格洛纳斯GLONASS、伽利略GALELIO和北斗BD的四大卫星导航系统,基于GNSS的RTK(Real-TimeKinematic,实时差分定位)技术的产品日趋成熟,广泛应用于测量测绘、精密导航等领。在同一个GNSS定位板卡可以连接双天线,则可以测量双天线间向量的航向和俯仰角信息,为载体提供航向和俯仰角信息。GNSS卫星系统具有长期稳定性,定位误差不随时间增加而发散,其不足之处在于GNSS信号容易受观测环境的影响,在GNSS卫星遮挡或者信号干扰时,GNSS不能正常定位、测速和测姿。
INS(Inertial Navigation System,惯性导航系统)可以测量载体的位置、速度和姿态,其优点是具有良好的短期精度,不受外界环境影响,隐蔽性好,缺点是导航精度随着时间发散。将GNSS/INS系统进行组合,取长补短,既可以保证短期精度,又有长期可用性,大大加大了系统的可用性和鲁棒性。
基于GNSS/INS的组合导航系统,通常是GNSS位置、速度与INS组合的松组合形式,或者基于GNSS伪距、伪距率和INS组合的紧组合形式,这都是基于单天线GNSS/INS组合的技术。对于双天线GNSS和INS的组合,主要实现方式是利用双天线的航向辅助INS,以提升INS的航向精度,对于因而整个组合导航系统的融合性能有待进一步提升。
发明内容
为了解决上述任一技术问题,本申请实施例提供了一种双天线GNSS/INS组合导航方法和装置。
为了达到本申请实施例目的,本申请实施例提供了一种双天线GNSS/INS组合导航系统的定位方法,包括:
在对INS进行初始化过程中,获取双天线GNSS的航向角初始值;
确定以IMU(Inertial Measurement Unit,惯性导航单元)为中心O的IMU坐标系中双天线矢量与IMU坐标系的OX轴的夹角;
利用所述夹角修正双天线GNSS的航向角初始值,得到INS的航向角初始值;
在利用INS的航向角初始值完成INS的初始化后,执行组合导航系统的定位操作。
一种存储介质,所述存储介质中存储有计算机程序,其中,所述计算机程序被设置为运行时执行上文所述的方法。
一种电子装置,包括存储器和处理器,所述存储器中存储有计算机程序,所述处理器被设置为运行所述计算机程序以执行上文所述的方法。
一种双天线GNSS/INS组合导航系统的定位装置,设置有上文所述的电子装置。
上述技术方案中的一个技术方案具有如下优点或有益效果:
在对INS进行初始化过程中,获取双天线GNSS的航向角初始值,确定以IMU为中心O的IMU坐标系中双天线矢量与IMU坐标系的OX轴的夹角,利用所述夹角修正双天线GNSS的航向角初始值,得到INS的航向角初始值,在利用INS的航向角初始值完成INS的初始化后,执行组合导航系统的定位操作,实现INS的航向角初始值的准确计算,提高INS的初始化精度。
本申请实施例的其它特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本申请实施例而了解。本申请实施例的目的和其他优点可通过在说明书、权利要求书以及附图中所特别指出的结构来实现和获得。
附图说明
附图用来提供对本申请实施例技术方案的进一步理解,并且构成说明书的一部分,与本申请实施例的实施例一起用于解释本申请实施例的技术方案,并不构成对本申请实施例技术方案的限制。
图1为本申请实施例提供的双天线GNSS/INS组合导航系统的定位方法的流程图;
图2为本申请实施例提供的双天线GNSS和INS的航向角的对比图;
图3为本申请实施例提供的双天线GNSS/INS组合导航系统的定位方法的另一流程图。
具体实施方式
为使本申请实施例的目的、技术方案和优点更加清楚明白,下文中将结合附图对本申请实施例的实施例进行详细说明。需要说明的是,在不冲突的情况下,本申请实施例中的实施例及实施例中的特征可以相互任意组合。
图1为本申请实施例提供的双天线GNSS/INS组合导航系统的定位方法的流程图。如图1所示,包括:
步骤101、在对INS进行初始化过程中,获取双天线GNSS的航向角初始值;
具体的,在载体静态时,GNSS信号良好的情况下,完成初始化INS的PVA(position、Velocity、Attitude,位置、速度和姿态),其中INS的初始化位置来自主天线P的GNSS位置,INS的速度信息初始化为零;根据加速度计的测量信息初始化得到姿态信息;具体参见计算表达式(1):
其中,θ为INS的俯仰角,γ为INS的横滚角,fx为加速度计的X轴测量值,fy为加速度计的Y轴测量值,g为地球重力加速度。
相关技术中,将双天线GNSS的航向角ψDualAnt作为INS初始化所使用的航向角。在实现本申请过程中,发现相关技术存在如下问题:
图2为本申请实施例提供的双天线GNSS和INS的航向角的对比图。如图2所示,双天线GNSS测向结果中航向为主天线P和从天线Q连线构成的向量的航向,而INS的航向是IMU前向轴的航向,二者由于安装结构不同,所指的航向角并不是同一个物理量,因而在双天线GNSS和INS组合时,需要确定二者航向角的偏差值后,才能在GNSS/INS组合时进行应用。
步骤102、确定以IMU为中心O的IMU坐标系中双天线矢量与IMU坐标系的OX轴的夹角,具体包括:
步骤1021、确定以IMU为中心的IMU坐标系中主天线的坐标P和从天线的坐标Q;
具体的,建立FRD/XYZ坐标系BIMU,双天线在车体上安装,令主天线为P,从天线为Q,其结构如图1所示,在IMU坐标系BIMU中,主天线的坐标P为(x1,y1,z1),从天线的坐标Q为(x2,y2,z2),其中P和Q的坐标数值即可通过精密仪器测量,也可通过米尺测量,允许存在几个厘米的误差。
步骤1022、计算基于IMU坐标系下的双天线矢量;
具体的,采用计算表达式(2)得到IMU坐标系下的双天线矢量PQb:
PQb=Q-P=(x2-x1,y2-y1,z2-z1) (2)
步骤1023、计算双天线矢量PQb与IMU的轴OX的夹角Δψ;
采用计算表达式(3)得到夹角Δψ:
步骤103、利用所述夹角修正双天线GNSS的航向角初始值,得到INS的航向角初始值;
其中,INS的航向角ψINS是通过计算表达式(4)得到的:
ψINS=ψDualAnt+Δψ; (4)
步骤104、在利用INS的航向角初始值完成INS的初始化后,执行组合导航系统的定位操作。
在INS完成初始对准后,双天线GNSS/INS组合导航系统可以正常工作,能够实时输出PVA信息。
本申请实施例提供的方法,在对INS进行初始化过程中,获取双天线GNSS的航向角初始值,确定以IMU为中心O的IMU坐标系中双天线矢量与IMU坐标系的OX轴的夹角,利用所述夹角修正双天线GNSS的航向角初始值,得到INS的航向角初始值,在利用INS的航向角初始值完成INS的初始化后,执行组合导航系统的定位操作,实现INS的航向角初始值的准确计算,提高INS的初始化精度。
下面对本申请实施例提供的方法进行说明:
图3为本申请实施例提供的双天线GNSS/INS组合导航系统的定位方法的另一流程图。如图3所示,包括:
步骤301、对组合导航系统进行初始化;
步骤302、以所述组合导航系统中误差参数为状态量X,构建所述组合导航系统的观测方程;
步骤303、在所述组合导航系统的观测方程中状态量X处于收敛后,获取同一时刻INS与双天线GNSS的姿态角,并根据INS与双天线GNSS的姿态角,计算姿态角偏差值,其中所述姿态角包括航向角和俯仰角中至少一个;
步骤304、根据双天线GNSS是否能够正常工作,分为如下三种情况:
步骤304A、如果双天线GNSS正常工作,利用姿态角偏差值修正INS系统的姿态角,并利用修正后的INS系统的姿态角和双天线GNSS的姿态角,进行组合导航系统的定位操作。
步骤304B、如果双天线GNSS不能正常工作,如果接收到输出双天线GNSS当前姿态信息的请求时,获取当前时刻INS的姿态角;根据INS的姿态角和姿态角偏差值,计算双天线GNSS的当前时刻姿态角,得到姿态角估计值;输出所述姿态角估计值。
步骤304C、在双天线GNSS失锁后,如果重新接收到GNSS信号,根据INS的姿态角和姿态角偏差值,进行双天线GNSS测姿计算,并利用计算结果和INS的姿态角进行组合导航系统的定位操作。
本发明充分利用双天线GNSS系统的测姿结果和INS的测姿结果进行组合,两个系统相互校正和补充,实时在线估计姿态角的偏差值,利用姿态角偏差值进行双天线姿态和INS姿态进行组合,使得在不同的时刻都能最大化的实现组合导航系统的最优性能,提升系统的可用性和鲁棒性,而且不用通过精密仪器进行提前标定,使用便捷,提升可用性和效率。
下面对步骤302进行说明:
位置误差微分方程参见计算表达式(5):
速度误差微分方程参见计算表达式(6):
姿态误差微分方程参见计算表达式(7):
加速度表和陀螺零偏建模为一阶高斯马尔科夫过程参见计算表达式(8):
将上式合并写为如计算表达式(9)格式:
对连续微分方程离散化,得到计算表达式(10):
X(k+1)=(I+FΔT)X(k); (10)
在计算表达式(10)中,(I+FΔT)即是离散状态下的转移矩阵,根据卡尔曼滤波算法公式用来预测状态量和误差协方差阵。
还可以将状态量扩维,添加上IMU的刻度因子误差,状态量变成21维,即其中δsa是加表的三轴刻度因子误差,δsg是陀螺的三轴刻度因子误差,该误差建模为一阶高斯马尔科夫过程,其微分方程如计算表达式(11):
根据主天线P的GNSS的定位结果或者伪距、载波、多普勒等观测量信息,构建GNSS/INS组合滤波观测方程,采用松组合或者紧组合模式进行状态量X的估计和修正,提升INS各个状态的精度。
下面对步骤303进行说明:
由于外部输入的主天线的坐标P(x1,y1,z1),从天线的坐标Q(x2,y2,z2)可能存在误差,导致初始化所确定的姿态角不精确,需要根据实时的双天线姿态和INS姿态进行滤波估计,以得到精确的姿态角偏差值。
在GNSS信号良好和INS动态对准收敛后,获取同一时刻惯性导航系统INS与双天线全球定位系统GNSS的姿态角,根据INS与双天线GNSS的姿态角,计算姿态角偏差值,包括:
获取第k时刻INS的航向角ψINS_k和双天线GNSS的航向角ψDualAnt_k,并计算第k时刻航向角偏差实时值Δψk;根据第k时刻航向角偏差实时值Δψk以及第k-1时刻航向角偏差稳定值计算第k时刻航向角偏差稳定值具体参见计算表达式(13):
Δψk=ψINS-ψDualAnt
和/或,
获取第k时刻INS的俯仰角θINS_k和双天线俯仰角θDualAnt_k,并计算第k时刻俯仰角偏差值Δθk;根据第k时刻俯仰角偏差值Δθk以及第k-1时刻俯仰角偏差稳定值计算第k时刻俯仰角偏差稳定值具体参见计算表达式(14):
Δθk=θINS_k-θDualAnt_k
其中,k=1,2,3,……,K;K为正整数。
下面对步骤304A进行说明:
利用姿态角偏差值,修正INS的姿态角,包括:
在得到航向角偏差值和俯仰角偏差值后,则可以将双天线GNSS姿态角和INS姿态角进行组合,以提升INS姿态精度,构建如下观测方程如计算表达式(15):
其中N为所述状态量的总维度,其中,在所述状态量中航向角和俯仰角位于第n+1维和第n+2维,其中n为大于或等于2且小于或等于N-2的整数;
利用式(15)的观测方程进行卡尔曼滤波测量更新,以提升INS的姿态精度。
上述实现方式提供了利用双天线的航向辅助INS,以提升INS的航向精度的具体实现手段。
下面对步骤304B进行说明:
在双天线GNSS处于失锁状态时,如果接收到输出双天线GNSS当前姿态信息的请求时,获取当前时刻INS的姿态角;
根据INS的姿态角和姿态角偏差值,计算双天线GNSS的当前时刻姿态角,得到姿态角估计值;
输出所述姿态角估计值。
根据INS的姿态角和姿态角偏差值可以得到双天线的姿态角,具体参见计算表达式(16):
ψDualAnt=ψINS-Δψ
θDualAnt=θINS-Δθ (16)
由于双天线GNSS和INS的姿态信息不是同一个物理量,用户如果需要INS的姿态信息,则可以将INS的结果输出,不受GNSS信号遮挡、中断等环境的影响;如果用户需要双天线对应的姿态信息,则可以根据式(16)折算到双天线的姿态信息上,也能够连续稳定的输出用户需要的信息,不受GNSS信号遮挡、中断等环境的影响,提升了系统的可用性和连续性;达到根据用户需求输出双天线GNSS姿态或者INS的姿态信息,且连续平滑稳定。
下面对步骤304C进行说明:
在双天线GNSS失锁后,如果重新接收到GNSS信号,根据INS当前时刻的姿态角和姿态角偏差值,得到当前时刻双天线GNSS的姿态信息,得到姿态角参考值;
根据所述姿态角参考值以及预先存储的主从天线的距离l,得到本地北东地NED坐标系n下主从天线间的第一相对位置矢量;
利用所述第二相对位置矢量,在天线GNSS的相对定位观测方程中,求解双天线GNSS的姿态信息。
具体的,在GNSS系统失锁后,如果再次捕捉到GNSS信号后,利用INS的姿态辅助双天线姿态计算,包括:
在GNSS信号良好时,通过构建主从天线载波相位的双差观测方程,进行整周模糊度的搜索固定,进而确定主从天线的相对位置矢量[Δx Δy Δz],根据该矢量可以确定主从天线的距离l,为了增加距离的精度,可以通过对多个历元的距离l进行平滑滤波,不妨已求得双天线间的向量长度为l,其中
由于过桥、树荫等造成GNSS信号失锁后,如果重新捕捉到GNSS信号,根据主从天线的GNSS观测量进行载波相位的模糊度固定,计算双天线的航向和俯仰角,由于INS的姿态信息不受环境影响,短时间内精度较高,因而可以利用INS的姿态信息辅助双天线姿态信息的确定和计算。根据式(12)(14),根据INS的姿态角和姿态角偏差值可以得到双天线的姿态角,具体参见计算表达式(16):
ψDualAnt=ψINS-Δψ
θDualAnt=θINS-Δθ (16)
在已知双天线间的向量长度为l时,可得在本地NED(North East Down,北东地)坐标系下,主从天线间的第一相对位置矢量为:
在本地位置的经度为λ,纬度为L时,可得从本地NED坐标系n到地心地固系e的转换矩阵具体参见表达式(18):
根据式(17)(18),将主从天线间的第一相对位置矢量从n系转换到e系,则可得第二相对位置矢量:
上式中的左侧[Δx Δy Δz]T即是双天线GNSS进行相对定位侧向时的待求量,则可根据式(19)的观测量,加入到双天线GNSS的相对定位观测方程中,可以加快整周模糊度的固定,加快双天线姿态信息的求解。
可选的,所述利用所述第二相对位置矢量,在天线GNSS的相对定位观测方程中,求解双天线GNSS的姿态信息之后,所述方法还包括:
判断求解得到的双天线GNSS的姿态信息和所述姿态角参考值之间的差值是否满足预设的判断条件,得到判断结果;
如果判断结果为不满足,则重新执行双天线GNSS的测姿计算;
如果判断结果为满足,则进行组合导航系统的定位操作。
具体的,根据双天线GNSS的观测量可以计算到航向角和俯仰角,也可以根据式(16)得到双天线的航向和俯仰角,将这两组数据进行比较,如果二者的误差小于一定门限,比如1deg,则双天线GNSS的姿态角是正确的,如果超过一定门限,比如2deg,则双天线GNSS的姿态角是错误的,将信息反馈给双天线GNSS测姿算法模块,复位双天线测姿算法模块,重新进行双天线测姿的计算。通过这种相互校验检测的方法,能够及时修正错误的算法结果,提升系统的鲁棒性
利用姿态角偏差值,进行双天线GNSS测姿信息正确性检测。
本申请实施例提供一种存储介质,所述存储介质中存储有计算机程序,其中,所述计算机程序被设置为运行时执行上文任一项中所述的方法。
本申请实施例提供一种电子装置,包括存储器和处理器,所述存储器中存储有计算机程序,所述处理器被设置为运行所述计算机程序以执行上文任一项中所述的方法。
本申请实施例提供一种双天线GNSS/INS组合导航系统的定位装置,设置有上文所述的电子装置。
本领域普通技术人员可以理解,上文中所公开方法中的全部或某些步骤、系统、装置中的功能模块/单元可以被实施为软件、固件、硬件及其适当的组合。在硬件实施方式中,在以上描述中提及的功能模块/单元之间的划分不一定对应于物理组件的划分;例如,一个物理组件可以具有多个功能,或者一个功能或步骤可以由若干物理组件合作执行。某些组件或所有组件可以被实施为由处理器,如数字信号处理器或微处理器执行的软件,或者被实施为硬件,或者被实施为集成电路,如专用集成电路。这样的软件可以分布在计算机可读介质上,计算机可读介质可以包括计算机存储介质(或非暂时性介质)和通信介质(或暂时性介质)。如本领域普通技术人员公知的,术语计算机存储介质包括在用于存储信息(诸如计算机可读指令、数据结构、程序模块或其他数据)的任何方法或技术中实施的易失性和非易失性、可移除和不可移除介质。计算机存储介质包括但不限于RAM、ROM、EEPROM、闪存或其他存储器技术、CD-ROM、数字多功能盘(DVD)或其他光盘存储、磁盒、磁带、磁盘存储或其他磁存储装置、或者可以用于存储期望的信息并且可以被计算机访问的任何其他的介质。此外,本领域普通技术人员公知的是,通信介质通常包含计算机可读指令、数据结构、程序模块或者诸如载波或其他传输机制之类的调制数据信号中的其他数据,并且可包括任何信息递送介质。
Claims (11)
1.一种双天线GNSS/INS组合导航系统的定位方法,其特征在于,包括:
在对惯性导航系统INS进行初始化过程中,获取双天线全球定位系统GNSS的航向角初始值;
确定以惯性导航单元IMU为中心O的IMU坐标系中双天线矢量与IMU坐标系的OX轴的夹角;
利用所述夹角修正双天线GNSS的航向角初始值,得到INS的航向角初始值;
在利用INS的航向角初始值完成INS的初始化后,执行组合导航系统的定位操作。
2.根据权利要求1所述的方法,其特征在于,所述执行组合导航系统的定位操作,包括:
以所述组合导航系统中误差参数为状态量X,构建所述组合导航系统的观测方程;
在所述组合导航系统的观测方程中状态量X处于收敛后,获取同一时刻INS与双天线GNSS的姿态角,其中所述姿态角包括航向角和俯仰角中至少一个;
根据INS与双天线GNSS的姿态角,计算姿态角偏差值;
在双天线GNSS正常工作时,利用姿态角偏差值,修正INS的姿态角,并利用修正后的INS系统的姿态角和双天线GNSS的姿态角,进行组合导航系统的定位操作。
3.根据权利要求2所述的方法,其特征在于:
获取第k时刻INS的航向角ψINS_k和双天线GNSS的航向角ψDualAnt_k,并计算第k时刻航向角偏差实时值Δψk;根据第k时刻航向角偏差实时值Δψk以及第k-1时刻航向角偏差稳定值计算第k时刻航向角偏差稳定值
和/或,
其中,k=1,2,3,……,K;K为正整数。
5.根据权利要2所述的方法,其特征在于,所述利用姿态角偏差值,修正INS的姿态角,包括:
构建姿态角偏差值的观测方程;
利用所述姿态角偏差值的观测方程,对所述组合导航系统的观测方程进行更新;
其中,所述姿态角偏差值的观测方程的表达式如下:
其中,ψINS和ψDualAnt分别表示INS系统和双天线GNSS系统所使用的航向角;θINS和θDualAnt分别表示INS系统和双天线GNSS系统所使用的俯仰角;Δψ和Δθ分别表示航向角偏差值和俯仰角偏差值;
其中N为所述状态量的总维度,其中,在所述状态量X中航向角误差和俯仰角误差位于第n+1维和第n+2维,其中n为大于或等于2且小于或等于N-2的整数。
6.根据权利要求2所述的方法,其特征在于,所述方法还包括:
在双天线GNSS不能正常工作时,如果接收到输出双天线GNSS当前姿态信息的请求时,获取当前时刻INS的姿态角;
根据INS的姿态角和姿态角偏差值,计算双天线GNSS的当前时刻姿态角,得到姿态角估计值;
输出所述姿态角估计值。
8.根据权利要求7所述的方法,其特征在于,所述利用所述第二相对位置矢量,在天线GNSS的相对定位观测方程中,求解双天线GNSS的姿态信息之后,所述方法还包括:
判断求解结果中的双天线GNSS的姿态信息所述姿态角参考值之间的差值是否满足预设的判断条件,得到判断结果;
如果判断结果为不满足,则重新执行双天线GNSS的测姿计算;
如果判断结果为满足,则进行组合导航系统的定位操作。
9.一种存储介质,其特征在于,所述存储介质中存储有计算机程序,其中,所述计算机程序被设置为运行时执行所述权利要求1至8任一项中所述的方法。
10.一种电子装置,包括存储器和处理器,其特征在于,所述存储器中存储有计算机程序,所述处理器被设置为运行所述计算机程序以执行所述权利要求1至8任一项中所述的方法。
11.一种双天线GNSS/INS组合导航系统的定位装置,其特征在于,设置有如权利要求10所述的电子装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210362719.4A CN114895340A (zh) | 2022-04-07 | 2022-04-07 | 双天线gnss/ins组合导航系统的定位方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210362719.4A CN114895340A (zh) | 2022-04-07 | 2022-04-07 | 双天线gnss/ins组合导航系统的定位方法和装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114895340A true CN114895340A (zh) | 2022-08-12 |
Family
ID=82714508
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210362719.4A Pending CN114895340A (zh) | 2022-04-07 | 2022-04-07 | 双天线gnss/ins组合导航系统的定位方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114895340A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116224406A (zh) * | 2023-04-23 | 2023-06-06 | 东南大学 | 一种低成本的多天线gnss/ins超紧组合多级抗干扰系统 |
-
2022
- 2022-04-07 CN CN202210362719.4A patent/CN114895340A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116224406A (zh) * | 2023-04-23 | 2023-06-06 | 东南大学 | 一种低成本的多天线gnss/ins超紧组合多级抗干扰系统 |
CN116224406B (zh) * | 2023-04-23 | 2024-04-26 | 东南大学 | 一种低成本的多天线gnss/ins超紧组合多级抗干扰系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6424915B1 (en) | System for determining the heading and/or attitude of a body | |
CN101382431B (zh) | 定位系统及其方法 | |
EP0856747A1 (en) | Method and apparatus for attitude determination utilizing an inertial measurement unit and a plurality of satellite transmitters | |
US20150019159A1 (en) | System and method for magnetometer calibration and compensation | |
US7355549B2 (en) | Apparatus and method for carrier phase-based relative positioning | |
CA3003298A1 (en) | Gnss and inertial navigation system utilizing relative yaw as an observable for an ins filter | |
CN105783922A (zh) | 针对基于磁性校准测量的混合导航方案的航向 | |
EP2927640A1 (en) | Global positioning system (gps) self-calibrating lever arm function | |
CN111982106A (zh) | 导航方法、装置、存储介质及电子装置 | |
CN110133692B (zh) | 惯导技术辅助的高精度gnss动态倾斜测量系统及方法 | |
KR100443550B1 (ko) | 오차보정시스템을 구비하는 관성측정유닛-지피에스통합시스템과 미지정수 검색범위 축소방법 및 사이클 슬립검출방법, 및 그를 이용한 항체 위치, 속도,자세측정방법 | |
CN102928858A (zh) | 基于改进扩展卡尔曼滤波的gnss单点动态定位方法 | |
CN112526573B (zh) | 对象定位方法和装置、存储介质及电子设备 | |
CN115096303B (zh) | 一种gnss多天线与ins紧组合定位定姿方法和设备 | |
CN108873034A (zh) | 一种惯导辅助载波模糊度解算的实现方法 | |
CN116540285B (zh) | 惯性辅助的gnss双天线定向方法、装置与电子设备 | |
CN110793518A (zh) | 一种海上平台的定位定姿方法及系统 | |
US10948292B2 (en) | Sensor error calculating device, attitude angle calculating apparatus, method of calculating sensor error and method of calculating attitude angle | |
CN114895340A (zh) | 双天线gnss/ins组合导航系统的定位方法和装置 | |
CN114355393A (zh) | 一种基于低成本接收机的三天线姿态估计方法 | |
RU2277696C2 (ru) | Интегрированная инерциально-спутниковая навигационная система | |
CN114397480B (zh) | 声学多普勒测速仪误差估计方法、装置及系统 | |
Falco et al. | MULTI-GNSS receivers/IMU system aimed at the design of a heading-constrained tightly-coupled algorithm | |
US10663557B2 (en) | Method and system of geolocation by direct calculation of movement elements | |
CN114019954B (zh) | 航向安装角标定方法、装置、计算机设备和存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |