CN107390250A - 一种基于惯性导航系统和双天线gps的定位测姿方法 - Google Patents
一种基于惯性导航系统和双天线gps的定位测姿方法 Download PDFInfo
- Publication number
- CN107390250A CN107390250A CN201710573215.6A CN201710573215A CN107390250A CN 107390250 A CN107390250 A CN 107390250A CN 201710573215 A CN201710573215 A CN 201710573215A CN 107390250 A CN107390250 A CN 107390250A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- solution
- mover
- float
- 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.)
- Granted
Links
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/53—Determining attitude
- G01S19/54—Determining attitude using carrier phase measurements; using long or short baseline interferometry
- G01S19/55—Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method
-
- 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
Abstract
本发明基于惯性导航系统和双天线GPS的定位测姿方法,在载体上固定设置惯性导航系统INS和呈几何分布的两个GPS信号接收天线且对应设置两台接收机;将载波相位双差观测方程进行线性化处理,采用CLAMBDA算法利用约束条件求得整周模糊度a的最小二乘浮动解和基线向量b的估计值及其方差‑协方差矩阵;同时,利用无约束的LAMBDA算法寻找一个最小二乘法估计解aLLS,根据该估计解aLLS与浮点解计算初始搜索空间大小,求得整周模糊度a;通过端点A和端点B的位置坐标和方向向量之间的关系,求解出载体的二维姿态信息。本发明的有益技术效果是减少了数据存储空间,提高了整周模糊度的搜索效率,提高了系统的整体导航精度与性能。
Description
技术领域
本发明涉及利用GPS卫星导航系统对载体进行姿态解算的方法,具体涉及到一种基于惯性导航系统和双天线GPS的定位测姿方法。
背景技术
随着科学技术的迅速发展,目前广泛应用于航空、航天、航海和地面载体的导航系统多种多样,存在各自的特点与优点,但同时也具有各自的缺陷。惯性导航系统(inertialnavigation system,INS)具有能够不依赖外界信息,完全独立自主地提供多种较高精度的导航参数的优点,具有抗电子辐射干扰、大机动飞行、隐蔽性好的特点。但是,惯性导航系统的检测精度主要取决于惯性测量器件(陀螺仪和加速度计),导航参数的误差随时间而累积,不适合长时间导航。GPS作为新型导航系统,能够进行全球、全天候、实时导航,其定位误差与时间无关,具有较高的定位和测速精度。但是,GPS的载体在做高动态的运动时,常使GPS接收机不易捕获和跟踪卫星载波信号,甚至产生周跳现象等。由此可见,GPS和INS具有优势互补的特点。
发明内容
为解决现有技术惯性导航系统和GPS定位系统各自存在的检测精度主要取决于惯性测量器件,不适合长时间导航及做高动态的运动时不易捕获和跟踪卫星载波信号等问题,本发明提出一种基于惯性导航系统和双天线GPS的定位测姿方法。
本发明基于惯性导航系统和双天线GPS的定位测姿方法,在载体上固定设置惯性导航系统INS和呈几何分布的两个GPS信号接收天线且对应设置两台接收机,使得两个GPS信号接收天线构成了一个二维基线向量AB;将基线的端点A作为坐标原点且采用A点位置的GPS原始数据解算结果作为端点A的位置坐标;将载波相位双差观测方程进行线性化处理,采用CLAMBDA算法利用约束条件求得整周模糊度a的最小二乘浮动解和基线向量b的估计值及其方差-协方差矩阵;同时,利用无约束的LAMBDA算法寻找一个最小二乘法估计解aLLS,根据该估计解aLLS与浮点解计算初始搜索空间大小,求得整周模糊度a,进而求出端点B的位置坐标;通过端点A和端点B的位置坐标和方向向量之间的关系,求解出载体的二维姿态信息。
进一步的,所述将载波相位双差观测方程进行线性化处理,包括,在载波相位双差模式下相对定位的线性化观测方程可表示为:
y=Aa+Bb+e (1)
式中,y为载波相位双差观测向量;a为整周模糊度向量;b为基线向量,属于3维实数向量R3;e为噪声及非建模误差项;A是整周模糊度向量的参数矩阵;B是基线向量的参数矩阵。
进一步的,所述采用CLAMBDA算法利用约束条件求得整周模糊度a的最小二乘浮动解和基线向量b的估计值及其方差-协方差矩阵;同时,利用无约束的LAMBDA算法寻找一个最小二乘法估计解aLLS,根据该估计解aLLS与浮点解计算初始搜索空间大小,求得整周模糊度a,包括以下步骤:
S1、通过标准最小二乘法平差求基线向量估计值和模糊度最小二乘浮点解与及相应的方差-协方差矩阵,所述方差-协方差矩阵如下式(2)所示:
式中,为整周模糊度浮点解的方差矩阵;为最小二乘模糊度浮点解与基线向量估计值的协方差值;为基线向量估计值与模糊度最小二乘浮点解的协方差值;为基线向量估计值的方差矩阵;
S2、利用模糊度最小二乘浮点解基线向量估计值和方差-协方差矩阵通过使式(3)的目标函数最小作为约束条件求得模糊度向量的固定解,其计算式如式(3)所示:
式中: 和分别为整周模糊度a的最小二乘浮点解和基线向量b的估计值;和分别为整周模糊度浮点解和基线向量估计值的方差矩阵;Zn表示整数域;其解计作为模糊度的整数最小二乘估计;
S3、用模糊度最小二乘浮点解与整数最小二乘模糊度估计值的差纠正基线向量的最小二乘估计值即可得到基线向量的确定值b:
S4、为了选择一个合适的搜索空间,可以将整周模糊度候选解的搜索空间Ω定义为:
式中:和分别为整周模糊度a的浮点解和基线向量最小二乘估计值 和分别为整周模糊度浮点解和基线向量最小二乘估计值的方差矩阵;Zn表示整数域;χ2表示搜索空间的大小;
同时,使用无约束的LAMBDA算法寻找一个整数最小二乘法估计解aLLS,根据该估计解aLLS计算初始搜索的空间大小式中,为整周模糊度a的浮点解;为整周模糊度浮点解的方差矩阵;如果初始搜索空间内无解,则将搜索空间按照的方式不断扩大,直到模糊度搜索空间内有解,所求出的解即为整周模糊度a;其中,设定所述按照的方式不断扩大搜索空间,直到通过CLAMBDA解算出的整周模糊度候选解个数超过最大范围800。
进一步的,在计算整周模糊度a的浮点解时,还包括将KALMAN滤波算法应用于CLAMBDA方法中模糊度浮点解的实时计算;包括以下步骤:
选取天线B所在位置坐标增量以及解算位置所需要的双差整周模糊度作为KALMAN滤波器的状态参数:即,
式中:Xk为状态参数矩阵;xk,yk,zk为端点B的位置坐标增量,为载波相位双差的整周模糊度,n为双差载波相位整周模糊度的个数;
系统的状态方程为:
式中:Xk为系统状态参数;Wk-1为系统噪声:E(Wk-1)=0,cov(Wk,Wj)=Qkδkj;状态转移矩阵为
设天线B的位置坐标为(X2,Y2,Z2),系统测量方程为:
Zk=HkδXk+Vk (8)
式中:Hk为观测矩阵;δXk为待估参数向量,包括位置分量参数、电离层和对流层延迟残差以及双差模糊度;Zk为观测量与计算量之差;Vk为观测噪声,且满足E(Vk-1)=0,cov(Vk,Vj)=Rkδkj;
KLAMAN滤波算法的递推公式如下:
初始值定义:
计算增益矩阵:
Xk+1,k+1=Xk,k+1+Kk+1[Zk+1-Hk+1δXk+1,k] (11)
参数的更新估计:
计算更新参数的方差—协方差阵:
上述各式中:Xk+1,k为k时刻预测的k+1时刻的转移矩阵;为k时刻预测的k+1时刻的状态转移矩阵;Xk,k为k时刻的转移矩阵;Pk+1,k为k时刻预测的k+1时刻的方差;Pk,k为k时刻的方差;T为转置矩阵;Qk为系统噪声方差;Xk+1,k+1为k+1时刻的增益矩阵;Xk,k+1为k+1时刻利用k时刻状态预测的结果;Kk+1为k+1时刻的各状态量增益矩阵;Zk+1为k+1时刻的测量方程;Hk+1为k+1时刻的观测矩阵;δXk+1,k=Xk+1,k-Xk,Xk为状态参数矩阵;Pk+1,k+1为k+1时刻的方差;I为1的矩阵;Kk为k时刻的各状态量增益矩阵;Rk为观测噪声方差;
采用上述系统状态方程、系统测量方程和KLAMAN滤波算法的递推公式即可求得整周模糊度a的浮点解
进一步的,所述通过端点A和端点B的位置坐标和方向向量之间的关系,求解出载体的二维姿态信息;包括,设端点A和端点B的位置坐标所确定的基线向量AB的坐标为(x12,y12,z12),则载体的二维坐标航向角α与俯仰角β就由下式确定:
进一步的,所述基于惯性导航系统和双天线GPS的定位测姿方法,还包括,当按照的方式不断扩大搜索空间的次数达到设定次数时,模糊度搜索空间内仍然无解,即判定姿态解算错误;此时,直接采用INS测量得到的航向角α、俯仰角β作为载体的姿态参数辅助模糊度搜索结果输出,保证整个系统的实时输出;同时,采用自适应度函数F(β,α)对模糊度搜索获得的双差整周模糊度浮点解的适应性进行评价,并在浮点解满足自适应度函数F(β,α)时,利用该浮点解解算出整周模糊度,进而求得端点B的位置坐标,最终求解出载体的二维姿态信息;其中,所述自适应度函数F(β,α)如下式所示:
式中,F(β,α)为定义的适应度函数,航向角α,俯仰角β可由INS测量得到,为双差整周模糊度浮点解。
本发明基于惯性导航系统和双天线GPS的定位测姿方法的有益技术效果是在很大程度上减少了数据存储空间,提高了整周模糊度的搜索效率,提高了系统的整体导航精度与性能。具有精度高、可靠性好和自主性强等显著优点。
附图说明
附图1为本发明基于惯性导航系统和双天线GPS的定位测姿方法的系统框架图;
附图2为本发明基于惯性导航系统和双天线GPS的定位测姿方法的算法框架图。
下面结合附图对本发明基于惯性导航系统和双天线GPS的定位测姿方法作进一步的说明。
具体实施方式
为了更清楚地说明本发明实施例的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。以下结合附图对本发明的优选实施例进行说明,应当理解,此处所描述的优选实施例仅用于说明和解释本发明,并不用于限定本发明。
附图1为本发明基于惯性导航系统和双天线GPS的定位测姿方法的系统框架图,附图2为本发明基于惯性导航系统和双天线GPS的定位测姿方法的算法框架图。由图可知,本发明基于惯性导航系统和双天线GPS的定位测姿方法,在载体上固定设置惯性导航系统INS和呈几何分布的两个GPS信号接收天线且对应设置两台接收机,使得两个GPS信号接收天线构成了一个二维基线向量AB;将基线的端点A作为坐标原点且采用A点位置的GPS原始数据解算结果作为端点A的位置坐标;将载波相位双差观测方程进行线性化处理,采用CLAMBDA算法利用约束条件求得整周模糊度a的最小二乘浮动解和基线向量b的估计值及其方差-协方差矩阵;同时,利用无约束的LAMBDA算法寻找一个最小二乘法估计解aLLS,根据该估计解aLLS与浮点解计算初始搜索空间大小,求得整周模糊度a,进而求出端点B的位置坐标;通过端点A和端点B的位置坐标和方向向量之间的关系,求解出载体的二维姿态信息。
作为具体实施方式,所述将载波相位双差观测方程进行线性化处理,包括,在载波相位双差模式下相对定位的线性化观测方程可表示为:
y=Aa+Bb+e (1)
式中,y为载波相位双差观测向量;a为整周模糊度向量;b为基线向量,属于3维实数向量R3;e为噪声及非建模误差项;A是整周模糊度向量的参数矩阵;B是基线向量的参数矩阵。
并且,所述采用CLAMBDA算法利用约束条件求得整周模糊度a的最小二乘浮动解和基线向量b的估计值及其方差-协方差矩阵;同时,利用无约束的LAMBDA算法寻找一个最小二乘法估计解aLLS,根据该估计解aLLS与浮点解计算初始搜索空间大小,求得整周模糊度a,包括以下步骤:
S1、通过标准最小二乘法平差求基线向量估计值和模糊度最小二乘浮点解与及相应的方差-协方差矩阵,所述方差-协方差矩阵如下式(2)所示:
式中,为整周模糊度浮点解的方差矩阵;为最小二乘模糊度浮点解与基线向量估计值的协方差值;为基线向量估计值与模糊度最小二乘浮点解的协方差值;为基线向量估计值的方差矩阵;
S2、利用模糊度最小二乘浮点解基线向量估计值和方差-协方差矩阵通过使式(3)的目标函数最小作为约束条件求得模糊度向量的固定解,其计算式如式(3)所示:
式中: 和分别为整周模糊度a的最小二乘浮点解和基线向量b的估计值;和分别为整周模糊度浮点解和基线向量估计值的方差矩阵;Zn表示整数域;其解计作为模糊度的整数最小二乘估计;
S3、用模糊度最小二乘浮点解与整数最小二乘模糊度估计值的差纠正基线向量的最小二乘估计值即可得到基线向量的确定值b:
S4、为了选择一个合适的搜索空间,可以将整周模糊度候选解的搜索空间Ω定义为:
式中:和分别为整周模糊度a的浮点解和基线向量最小二乘估计值 和分别为整周模糊度浮点解和基线向量最小二乘估计值的方差矩阵;Zn表示整数域;χ2表示搜索空间的大小;
同时,使用无约束的LAMBDA算法寻找一个整数最小二乘法估计解aLLS,根据该估计解aLLS计算初始搜索的空间大小式中,为整周模糊度a的浮点解;为整周模糊度浮点解的方差矩阵;如果初始搜索空间内无解,则将搜索空间按照的方式不断扩大,直到模糊度搜索空间内有解,所求出的解即为整周模糊度a;其中,设定所述按照的方式不断扩大搜索空间,直到通过CLAMBDA解算出的整周模糊度候选解个数超过最大范围800。
由于最小二乘法在求浮点解过程中,要对所有观测值进行整体的平差,其数据处理量巨大,由于在处理超长时间的静态观测数据时,其运算速度的劣势会非常明显,而KALMAN滤波算法在进行计算时,只需要对前一次的信息进行运算和存储。为了实现运算的实时性,本发明在计算整周模糊度a的浮点解时,还包括将KALMAN滤波算法应用于CLAMBDA方法中模糊度浮点解的实时计算;包括以下步骤:
选取天线B所在位置坐标增量以及解算位置所需要的双差整周模糊度作为KALMAN滤波器的状态参数:即,
式中:Xk为状态参数矩阵;xk,yk,zk为端点B的位置坐标增量,为载波相位双差的整周模糊度,n为双差载波相位整周模糊度的个数;
系统的状态方程为:
式中:Xk为系统状态参数;Wk-1为系统噪声:E(Wk-1)=0,cov(Wk,Wj)=Qkδkj;状态转移矩阵为
设天线B的位置坐标为(X2,Y2,Z2),系统测量方程为:
Zk=HkδXk+Vk (8)
式中:Hk为观测矩阵;δXk为待估参数向量,包括位置分量参数、电离层和对流层延迟残差以及双差模糊度;Zk为观测量与计算量之差;Vk为观测噪声,且满足E(Vk-1)=0,cov(Vk,Vj)=Rkδkj;
KLAMAN滤波算法的递推公式如下:
初始值定义:
计算增益矩阵:
Xk+1,k+1=Xk,k+1+Kk+1[Zk+1-Hk+1δXk+1,k] (11)
参数的更新估计:
计算更新参数的方差—协方差阵:
上述各式中:Xk+1,k为k时刻预测的k+1时刻的转移矩阵;为k时刻预测的k+1时刻的状态转移矩阵;Xk,k为k时刻的转移矩阵;Pk+1,k为k时刻预测的k+1时刻的方差;Pk,k为k时刻的方差;T为转置矩阵;Qk为系统噪声方差;Xk+1,k+1为k+1时刻的增益矩阵;Xk,k+1为k+1时刻利用k时刻状态预测的结果;Kk+1为k+1时刻的各状态量增益矩阵;Zk+1为k+1时刻的测量方程;Hk+1为k+1时刻的观测矩阵;δXk+1,k=Xk+1,k-Xk,Xk为状态参数矩阵;Pk+1,k+1为k+1时刻的方差;I为1的矩阵;Kk为k时刻的各状态量增益矩阵;Rk为观测噪声方差;
采用上述系统状态方程、系统测量方程和KLAMAN滤波算法的递推公式即可求得整周模糊度a的浮点解
显然,KALMAN滤波器对初始值没有特别的要求,但如果滤波初始值精度提高,可以缩短滤波达到系统精度的时间,很大程度上减少了数据存储空间,提高了整周模糊度的搜索效率。利用KALMAN滤波方法求解整周模糊度解,克服了最小二乘法对大量数据处理速度慢的缺点,极大的减少了计算量,提高了算法解算效率。
作为具体实施方式,所述通过端点A和端点B的位置坐标和方向向量之间的关系,求解出载体的二维姿态信息;包括,设端点A和端点B的位置坐标所确定的基线向量AB的坐标为(x12,y12,z12),则载体的二维坐标航向角α与俯仰角β就由下式确定:
本发明方法确实提高了姿态解算的成功率,但仍会有一部分姿态角解算错误。当得到的整周模糊度解的个数超过一定范围时,仍未找到满足约束条件的整周模糊度解即判定姿态解算错误。此时可利用INS信息辅助AFM算法搜索解算姿态角。将所得姿态角作为接收机的输出姿态角,保证整个系统的实时输出。因此,本发明基于惯性导航系统和双天线GPS的定位测姿方法,还包括,当按照的方式不断扩大搜索空间的次数达到设定次数时,模糊度搜索空间内仍然无解,即判定姿态解算错误;此时,直接采用INS测量得到的航向角α、俯仰角β作为载体的姿态参数辅助模糊度搜索结果输出,保证整个系统的实时输出;同时,采用自适应度函数F(β,α)对模糊度搜索获得的双差整周模糊度浮点解的适应性进行评价,并在浮点解满足自适应度函数F(β,α)时,利用该浮点解解算出整周模糊度,进而求得端点B的位置坐标,最终求解出载体的二维姿态信息;其中,所述自适应度函数F(β,α)如下式所示:
式中,F(β,α)为定义的适应度函数,航向角α,俯仰角β可由INS测量得到,为双差整周模糊度浮点解。
显然,通过利用INS信息辅助GPS解算浮点解,增加求解浮点解方程的冗余度来提高浮点解的精度,进而提高GPS定姿的成功率。同时,在INS辅助求解浮点解时,增加了权重的概念,可以根据INS的性能调整该参数。根据解算出的整周模糊度,求解出天线B的最佳位置。从而确定基线向量AB,载体的姿态角即可完全确定。
显然,本发明基于惯性导航系统和双天线GPS的定位测姿方法的有益技术效果是在很大程度上减少了数据存储空间,提高了整周模糊度的搜索效率,提高了系统的整体导航精度与性能。具有精度高、可靠性好和自主性强等显著优点。
Claims (6)
1.一种基于惯性导航系统和双天线GPS的定位测姿方法,其特征在于,在载体上固定设置惯性导航系统INS和呈几何分布的两个GPS信号接收天线且对应设置两台接收机,使得两个GPS信号接收天线构成了一个二维基线向量AB;将基线的端点A作为坐标原点且采用A点位置的GPS原始数据解算结果作为端点A的位置坐标;将载波相位双差观测方程进行线性化处理,采用CLAMBDA算法利用约束条件求得整周模糊度a的最小二乘浮动解和基线向量b的估计值及其方差-协方差矩阵;同时,利用无约束的LAMBDA算法寻找一个最小二乘法估计解aLLS,根据该估计解aLLS与浮点解计算初始搜索空间大小,求得整周模糊度a,进而求出端点B的位置坐标;通过端点A和端点B的位置坐标和方向向量之间的关系,求解出载体的二维姿态信息。
2.根据权利要求1所述基于惯性导航系统和双天线GPS的定位测姿方法,其特征在于,所述将载波相位双差观测方程进行线性化处理,包括,在载波相位双差模式下相对定位的线性化观测方程可表示为:
y=Aa+Bb+e (1)
式中,y为载波相位双差观测向量;a为整周模糊度向量;b为基线向量,属于3维实数向量R3;e为噪声及非建模误差项;A是整周模糊度向量的参数矩阵;B是基线向量的参数矩阵。
3.根据权利要求1所述基于惯性导航系统和双天线GPS的定位测姿方法,其特征在于,所述采用CLAMBDA算法利用约束条件求得整周模糊度a的最小二乘浮动解和基线向量b的估计值及其方差-协方差矩阵;同时,利用无约束的LAMBDA算法寻找一个最小二乘法估计解aLLS,根据该估计解aLLS与浮点解计算初始搜索空间大小,求得整周模糊度a,包括以下步骤:
S1、通过标准最小二乘法平差求基线向量估计值和模糊度最小二乘浮点解与及相应的方差-协方差矩阵,所述方差-协方差矩阵如下式(2)所示:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>b</mi>
<mo>^</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>Q</mi>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
</msub>
</mtd>
<mtd>
<msub>
<mi>Q</mi>
<mrow>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mover>
<mi>b</mi>
<mo>^</mo>
</mover>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>Q</mi>
<mrow>
<mover>
<mi>b</mi>
<mo>^</mo>
</mover>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Q</mi>
<mover>
<mi>b</mi>
<mo>^</mo>
</mover>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,为整周模糊度浮点解的方差矩阵;为最小二乘模糊度浮点解与基线向量估计值的协方差值;为基线向量估计值与模糊度最小二乘浮点解的协方差值;为基线向量估计值的方差矩阵;
S2、利用模糊度最小二乘浮点解基线向量估计值和方差-协方差矩阵通过使式(3)的目标函数最小作为约束条件求得模糊度向量的固定解,其计算式如式(3)所示:
<mrow>
<msub>
<mi>min</mi>
<mrow>
<mi>a</mi>
<mo>&Element;</mo>
<msup>
<mi>Z</mi>
<mi>n</mi>
</msup>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mo>-</mo>
<mi>a</mi>
<mo>|</mo>
<msubsup>
<mo>|</mo>
<msub>
<mi>Q</mi>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
</msub>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>b</mi>
<mo>^</mo>
</mover>
<mo>-</mo>
<mover>
<mi>b</mi>
<mo>&OverBar;</mo>
</mover>
<mo>|</mo>
<msubsup>
<mo>|</mo>
<msub>
<mi>Q</mi>
<mover>
<mi>b</mi>
<mo>^</mo>
</mover>
</msub>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
式中: 和分别为整周模糊度a的最小二乘浮点解和基线向量b的估计值;和分别为整周模糊度浮点解和基线向量估计值的方差矩阵;Zn表示整数域;其解计作为模糊度的整数最小二乘估计;
S3、用模糊度最小二乘浮点解与整数最小二乘模糊度估计值的差纠正基线向量的最小二乘估计值即可得到基线向量的确定值b:
S4、为了选择一个合适的搜索空间,可以将整周模糊度候选解的搜索空间Ω定义为:
式中:和分别为整周模糊度a的浮点解和基线向量最小二乘估计值 和分别为整周模糊度浮点解和基线向量最小二乘估计值的方差矩阵;Zn表示整数域;χ2表示搜索空间的大小;
同时,使用无约束的LAMBDA算法寻找一个整数最小二乘法估计解aLLS,根据该估计解aLLS计算初始搜索的空间大小式中,为整周模糊度a的浮点解;为整周模糊度浮点解的方差矩阵;如果初始搜索空间内无解,则将搜索空间按照的方式不断扩大,直到模糊度搜索空间内有解,所求出的解即为整周模糊度a;其中,设定所述按照的方式不断扩大搜索空间,直到通过CLAMBDA解算出的整周模糊度候选解个数超过最大范围800。
4.根据权利要求3所述基于惯性导航系统和双天线GPS的定位测姿方法,其特征在于,在计算整周模糊度a的浮点解时,还包括将KALMAN滤波算法应用于CLAMBDA方法中模糊度浮点解的实时计算;包括以下步骤:
选取天线B所在位置坐标增量以及解算位置所需要的双差整周模糊度作为KALMAN滤波器的状态参数:即,
<mrow>
<msub>
<mi>X</mi>
<mi>k</mi>
</msub>
<mo>=</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>k</mi>
</msub>
<mo>,</mo>
<msub>
<mi>y</mi>
<mi>k</mi>
</msub>
<mo>,</mo>
<msub>
<mi>z</mi>
<mi>k</mi>
</msub>
<mo>,</mo>
<mo>&dtri;</mo>
<msub>
<mi>&Delta;N</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<mo>&dtri;</mo>
<msub>
<mi>&Delta;N</mi>
<mn>2</mn>
</msub>
<mo>,</mo>
<mo>...</mo>
<mo>&dtri;</mo>
<msub>
<mi>&Delta;N</mi>
<mi>n</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
式中:Xk为状态参数矩阵;xk,yk,zk为端点B的位置坐标增量,为载波相位双差的整周模糊度,n为双差载波相位整周模糊度的个数;
系统的状态方程为:
式中:Xk为系统状态参数;Wk-1为系统噪声:E(Wk-1)=0,cov(Wk,Wj)=Qkδkj;状态转移矩阵为
设天线B的位置坐标为(X2,Y2,Z2),系统测量方程为:
Zk=HkδXk+Vk (8)
式中:Hk为观测矩阵;δXk为待估参数向量,包括位置分量参数、电离层和对流层延迟残差以及双差模糊度;Zk为观测量与计算量之差;Vk为观测噪声,且满足E(Vk-1)=0,cov(Vk,Vj)=Rkδkj;
KLAMAN滤波算法的递推公式如下:
初始值定义:
计算增益矩阵:
Xk+1,k+1=Xk,k+1+Kk+1[Zk+1-Hk+1δXk+1,k] (11)
参数的更新估计:
<mrow>
<msub>
<mi>K</mi>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>P</mi>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>,</mo>
<mi>k</mi>
</mrow>
</msub>
<msubsup>
<mi>H</mi>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
<mi>T</mi>
</msubsup>
<msup>
<mrow>
<mo>&lsqb;</mo>
<msub>
<mi>H</mi>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>P</mi>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<msubsup>
<mi>H</mi>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
<mi>T</mi>
</msubsup>
<mo>+</mo>
<msub>
<mi>P</mi>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
计算更新参数的方差—协方差阵:
<mrow>
<msub>
<mi>P</mi>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>,</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mi>I</mi>
<mo>-</mo>
<msub>
<mi>K</mi>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>H</mi>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>P</mi>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>,</mo>
<mi>k</mi>
</mrow>
</msub>
<msup>
<mrow>
<mo>(</mo>
<mi>I</mi>
<mo>-</mo>
<msub>
<mi>K</mi>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>H</mi>
<mrow>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>+</mo>
<msub>
<mi>K</mi>
<mi>k</mi>
</msub>
<msub>
<mi>R</mi>
<mi>k</mi>
</msub>
<msubsup>
<mi>K</mi>
<mi>k</mi>
<mi>T</mi>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
2
上述各式中:Xk+1,k为k时刻预测的k+1时刻的转移矩阵;为k时刻预测的k+1时刻的状态转移矩阵;Xk,k为k时刻的转移矩阵;Pk+1,k为k时刻预测的k+1时刻的方差;Pk,k为k时刻的方差;T为转置矩阵;Qk为系统噪声方差;Xk+1,k+1为k+1时刻的增益矩阵;Xk,k+1为k+1时刻利用k时刻状态预测的结果;Kk+1为k+1时刻的各状态量增益矩阵;Zk+1为k+1时刻的测量方程;Hk+1为k+1时刻的观测矩阵;δXk+1,k=Xk+1,k-Xk,Xk为状态参数矩阵;Pk+1,k+1为k+1时刻的方差;I为1的矩阵;Kk为k时刻的各状态量增益矩阵;Rk为观测噪声方差;
采用上述系统状态方程、系统测量方程和KLAMAN滤波算法的递推公式即可求得整周模糊度a的浮点解
5.根据权利要求1所述基于惯性导航系统和双天线GPS的定位测姿方法,其特征在于,所述通过端点A和端点B的位置坐标和方向向量之间的关系,求解出载体的二维姿态信息;包括,设端点A和端点B的位置坐标所确定的基线向量AB的坐标为(x12,y12,z12),则载体的二维坐标航向角α与俯仰角β就由下式确定:
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&alpha;</mi>
<mo>=</mo>
<mfrac>
<msub>
<mi>y</mi>
<mn>12</mn>
</msub>
<msub>
<mi>x</mi>
<mn>12</mn>
</msub>
</mfrac>
<mi>&alpha;</mi>
<mo>=</mo>
<mi>arctan</mi>
<mi>&alpha;</mi>
<mfrac>
<msub>
<mi>y</mi>
<mn>12</mn>
</msub>
<msub>
<mi>x</mi>
<mn>12</mn>
</msub>
</mfrac>
</mrow>
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&beta;</mi>
<mo>=</mo>
<mfrac>
<msub>
<mi>z</mi>
<mn>12</mn>
</msub>
<msqrt>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>12</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>y</mi>
<mn>12</mn>
</msub>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mfrac>
<mi>&beta;</mi>
<mo>=</mo>
<mi>arctan</mi>
<mfrac>
<msub>
<mi>z</mi>
<mn>12</mn>
</msub>
<msqrt>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>12</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>y</mi>
<mn>12</mn>
</msub>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mfrac>
<mo>.</mo>
</mrow>
6.根据权利要求1至5中任一项所述基于惯性导航系统和双天线GPS的定位测姿方法,其特征在于,所述基于惯性导航系统和双天线GPS的定位测姿方法,还包括,当按照的方式不断扩大搜索空间的次数达到设定次数时,模糊度搜索空间内仍然无解,即判定姿态解算错误;此时,直接采用INS测量得到的航向角α、俯仰角β作为载体的姿态参数辅助模糊度搜索结果输出,保证整个系统的实时输出;同时,采用自适应度函数F(β,α)对模糊度搜索获得的双差整周模糊度浮点解的适应性进行评价,并在浮点解满足自适应度函数F(β,α)时,利用该浮点解解算出整周模糊度,进而求得端点B的位置坐标,最终求解出载体的二维姿态信息;其中,所述自适应度函数F(β,α)如下式所示:
<mrow>
<mi>F</mi>
<mrow>
<mo>(</mo>
<mi>&beta;</mi>
<mo>,</mo>
<mi>&alpha;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mi>n</mi>
</mfrac>
<msubsup>
<mi>&Sigma;</mi>
<mrow>
<mi>k</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mi>&pi;</mi>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mover>
<mi>N</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>14</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,F(β,α)为定义的适应度函数,航向角α,俯仰角β可由INS测量得到,为双差整周模糊度浮点解。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710573215.6A CN107390250B (zh) | 2017-07-14 | 2017-07-14 | 一种基于惯性导航系统和双天线gps的定位测姿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710573215.6A CN107390250B (zh) | 2017-07-14 | 2017-07-14 | 一种基于惯性导航系统和双天线gps的定位测姿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107390250A true CN107390250A (zh) | 2017-11-24 |
CN107390250B CN107390250B (zh) | 2019-10-25 |
Family
ID=60340609
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710573215.6A Active CN107390250B (zh) | 2017-07-14 | 2017-07-14 | 一种基于惯性导航系统和双天线gps的定位测姿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107390250B (zh) |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108802782A (zh) * | 2018-05-18 | 2018-11-13 | 东南大学 | 一种惯导辅助的北斗三频载波相位整周模糊度求解方法 |
CN108931800A (zh) * | 2018-08-23 | 2018-12-04 | 上海海积信息科技股份有限公司 | 一种定向方法及装置 |
CN109917436A (zh) * | 2019-04-28 | 2019-06-21 | 中国人民解放军国防科技大学 | 一种卫星/惯性组合实时精密相对动基准定位方法 |
CN110109166A (zh) * | 2019-04-30 | 2019-08-09 | 东南大学 | 一种快速得到高可靠性卫星定位整数解的方法 |
CN110133702A (zh) * | 2019-05-13 | 2019-08-16 | 桂林电子科技大学 | 一种基于正交变换的姿态测量方法和设备 |
CN111381266A (zh) * | 2020-05-12 | 2020-07-07 | 泉州信息工程学院 | 整周模糊度确定方法、装置、电子设备及计算机可读介质 |
CN112904315A (zh) * | 2021-01-12 | 2021-06-04 | 广州广电研究院有限公司 | 一种激光雷达点云数据的校正方法、装置和介质 |
CN113064195A (zh) * | 2021-03-16 | 2021-07-02 | 西南交通大学 | 一种利用多天线几何特征的高精度低计算载体测姿方法 |
CN113091742A (zh) * | 2021-03-30 | 2021-07-09 | 北京邮电大学 | 一种融合定位方法、装置、电子设备及存储介质 |
CN113253322A (zh) * | 2021-04-12 | 2021-08-13 | 中国人民解放军军事科学院国防科技创新研究院 | 基于双天线的移动载体相对位置解算方法 |
CN113267800A (zh) * | 2021-05-21 | 2021-08-17 | 中国联合网络通信集团有限公司 | 定位定姿方法、装置、设备、存储介质及其系统 |
CN113965556A (zh) * | 2021-10-21 | 2022-01-21 | 飞纳经纬科技(北京)有限公司 | 基于web的惯性导航姿态3D实时展示的方法、装置及系统 |
CN115128656A (zh) * | 2022-07-07 | 2022-09-30 | 桂林电子科技大学 | 一种rtk-gnss抗差滤波姿态解算方法 |
CN116819580A (zh) * | 2023-08-23 | 2023-09-29 | 浙江中裕通信技术有限公司 | 一种惯性辅助的双天线gnss海上船舶姿态确定方法 |
CN116879935A (zh) * | 2023-09-06 | 2023-10-13 | 江西北斗云智慧科技有限公司 | 一种用于北斗定位的整周模糊度确定方法、系统及计算机 |
CN117075166A (zh) * | 2023-10-17 | 2023-11-17 | 智慧司南(天津)科技发展有限公司 | 一种船用卫星罗经艏向平滑方法 |
CN117250646A (zh) * | 2023-11-17 | 2023-12-19 | 毫厘智能科技(江苏)有限公司 | 基于芯片的测向方法及装置、芯片模组及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102508275A (zh) * | 2011-10-28 | 2012-06-20 | 北京航空航天大学 | 多天线gps/gf-ins深度组合定姿方法 |
CN103454664A (zh) * | 2013-08-20 | 2013-12-18 | 中国人民解放军国防科学技术大学 | 一种基于陀螺测量信息约束的gnss载波相位模糊度求解方法 |
CN103744101A (zh) * | 2014-01-02 | 2014-04-23 | 上海大学 | 一种低成本ahrs辅助gps确定整周模糊度装置及方法 |
CN104297772A (zh) * | 2013-07-16 | 2015-01-21 | 成都国星通信有限公司 | 基于载波相位差分的双天线一体式定位定向系统及方法 |
CN106443746A (zh) * | 2016-07-19 | 2017-02-22 | 招商局重庆交通科研设计院有限公司 | 一种低成本双天线gnss/ahrs组合测姿方法 |
-
2017
- 2017-07-14 CN CN201710573215.6A patent/CN107390250B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102508275A (zh) * | 2011-10-28 | 2012-06-20 | 北京航空航天大学 | 多天线gps/gf-ins深度组合定姿方法 |
CN104297772A (zh) * | 2013-07-16 | 2015-01-21 | 成都国星通信有限公司 | 基于载波相位差分的双天线一体式定位定向系统及方法 |
CN103454664A (zh) * | 2013-08-20 | 2013-12-18 | 中国人民解放军国防科学技术大学 | 一种基于陀螺测量信息约束的gnss载波相位模糊度求解方法 |
CN103744101A (zh) * | 2014-01-02 | 2014-04-23 | 上海大学 | 一种低成本ahrs辅助gps确定整周模糊度装置及方法 |
CN106443746A (zh) * | 2016-07-19 | 2017-02-22 | 招商局重庆交通科研设计院有限公司 | 一种低成本双天线gnss/ahrs组合测姿方法 |
Cited By (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108802782B (zh) * | 2018-05-18 | 2021-02-09 | 东南大学 | 一种惯导辅助的北斗三频载波相位整周模糊度求解方法 |
WO2019218766A1 (zh) * | 2018-05-18 | 2019-11-21 | 东南大学 | 一种惯导辅助的北斗三频载波相位整周模糊度求解方法 |
CN108802782A (zh) * | 2018-05-18 | 2018-11-13 | 东南大学 | 一种惯导辅助的北斗三频载波相位整周模糊度求解方法 |
CN108931800A (zh) * | 2018-08-23 | 2018-12-04 | 上海海积信息科技股份有限公司 | 一种定向方法及装置 |
CN109917436A (zh) * | 2019-04-28 | 2019-06-21 | 中国人民解放军国防科技大学 | 一种卫星/惯性组合实时精密相对动基准定位方法 |
CN110109166A (zh) * | 2019-04-30 | 2019-08-09 | 东南大学 | 一种快速得到高可靠性卫星定位整数解的方法 |
US11686860B2 (en) | 2019-04-30 | 2023-06-27 | Southeast University | Method for quickly acquiring highly reliable integer solution for satellite positioning |
CN110109166B (zh) * | 2019-04-30 | 2020-06-09 | 东南大学 | 一种快速得到高可靠性卫星定位整数解的方法 |
WO2020220579A1 (zh) * | 2019-04-30 | 2020-11-05 | 东南大学 | 一种快速得到高可靠性卫星定位整数解的方法 |
CN110133702A (zh) * | 2019-05-13 | 2019-08-16 | 桂林电子科技大学 | 一种基于正交变换的姿态测量方法和设备 |
CN110133702B (zh) * | 2019-05-13 | 2022-12-27 | 桂林电子科技大学 | 一种基于正交变换的姿态测量方法和设备 |
CN111381266A (zh) * | 2020-05-12 | 2020-07-07 | 泉州信息工程学院 | 整周模糊度确定方法、装置、电子设备及计算机可读介质 |
CN112904315A (zh) * | 2021-01-12 | 2021-06-04 | 广州广电研究院有限公司 | 一种激光雷达点云数据的校正方法、装置和介质 |
CN112904315B (zh) * | 2021-01-12 | 2024-04-26 | 广州广电研究院有限公司 | 一种激光雷达点云数据的校正方法、装置和介质 |
CN113064195A (zh) * | 2021-03-16 | 2021-07-02 | 西南交通大学 | 一种利用多天线几何特征的高精度低计算载体测姿方法 |
CN113064195B (zh) * | 2021-03-16 | 2023-09-01 | 西南交通大学 | 一种利用多天线几何特征的高精度低计算载体测姿方法 |
CN113091742A (zh) * | 2021-03-30 | 2021-07-09 | 北京邮电大学 | 一种融合定位方法、装置、电子设备及存储介质 |
CN113091742B (zh) * | 2021-03-30 | 2023-11-17 | 北京邮电大学 | 一种融合定位方法、装置、电子设备及存储介质 |
CN113253322A (zh) * | 2021-04-12 | 2021-08-13 | 中国人民解放军军事科学院国防科技创新研究院 | 基于双天线的移动载体相对位置解算方法 |
CN113267800A (zh) * | 2021-05-21 | 2021-08-17 | 中国联合网络通信集团有限公司 | 定位定姿方法、装置、设备、存储介质及其系统 |
CN113965556B (zh) * | 2021-10-21 | 2023-10-31 | 飞纳经纬科技(北京)有限公司 | 基于web的惯性导航姿态3D实时展示的方法、装置及系统 |
CN113965556A (zh) * | 2021-10-21 | 2022-01-21 | 飞纳经纬科技(北京)有限公司 | 基于web的惯性导航姿态3D实时展示的方法、装置及系统 |
CN115128656A (zh) * | 2022-07-07 | 2022-09-30 | 桂林电子科技大学 | 一种rtk-gnss抗差滤波姿态解算方法 |
CN116819580A (zh) * | 2023-08-23 | 2023-09-29 | 浙江中裕通信技术有限公司 | 一种惯性辅助的双天线gnss海上船舶姿态确定方法 |
CN116819580B (zh) * | 2023-08-23 | 2023-11-10 | 浙江中裕通信技术有限公司 | 一种惯性辅助的双天线gnss海上船舶姿态确定方法 |
CN116879935A (zh) * | 2023-09-06 | 2023-10-13 | 江西北斗云智慧科技有限公司 | 一种用于北斗定位的整周模糊度确定方法、系统及计算机 |
CN116879935B (zh) * | 2023-09-06 | 2023-12-01 | 江西北斗云智慧科技有限公司 | 一种用于北斗定位的整周模糊度确定方法、系统及计算机 |
CN117075166A (zh) * | 2023-10-17 | 2023-11-17 | 智慧司南(天津)科技发展有限公司 | 一种船用卫星罗经艏向平滑方法 |
CN117075166B (zh) * | 2023-10-17 | 2023-12-15 | 智慧司南(天津)科技发展有限公司 | 一种船用卫星罗经艏向平滑方法 |
CN117250646A (zh) * | 2023-11-17 | 2023-12-19 | 毫厘智能科技(江苏)有限公司 | 基于芯片的测向方法及装置、芯片模组及存储介质 |
CN117250646B (zh) * | 2023-11-17 | 2024-02-02 | 毫厘智能科技(江苏)有限公司 | 基于芯片的测向方法及装置、芯片模组及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN107390250B (zh) | 2019-10-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107390250A (zh) | 一种基于惯性导航系统和双天线gps的定位测姿方法 | |
CN107272039B (zh) | 一种基于双天线gps的定位测姿方法 | |
CN109556632B (zh) | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 | |
CN107655476B (zh) | 基于多信息融合补偿的行人高精度足部导航方法 | |
Hong et al. | A car test for the estimation of GPS/INS alignment errors | |
CN106990424B (zh) | 一种双天线gps测姿方法 | |
CN104597471B (zh) | 面向时钟同步多天线gnss接收机的定向测姿方法 | |
Hong et al. | Experimental study on the estimation of lever arm in GPS/INS | |
CN102565834B (zh) | 一种单频gps测向系统及其测向定位方法 | |
CN109556631B (zh) | 一种基于最小二乘的ins/gnss/偏振/地磁组合导航系统对准方法 | |
CN104697520B (zh) | 一体化无陀螺捷联惯导系统与gps系统组合导航方法 | |
CN102928858A (zh) | 基于改进扩展卡尔曼滤波的gnss单点动态定位方法 | |
CN104049269A (zh) | 一种基于激光测距和mems/gps组合导航系统的目标导航测绘方法 | |
JP2002054946A (ja) | 物体の姿勢検出装置および整数バイアス再決定方法 | |
CN105353392A (zh) | 基于gnss多天线的动态载体精密定位方法 | |
CN105988129A (zh) | 一种基于标量估计算法的ins/gnss组合导航方法 | |
CN105158778A (zh) | 多系统联合实施载波相位差分故障卫星剔除方法及其系统 | |
KR20020080829A (ko) | 오차보정시스템을 구비하는 관성측정유닛-지피에스통합시스템과 미지정수 검색범위 축소방법 및 사이클 슬립검출방법, 및 그를 이용한 항체 위치, 속도,자세측정방법 | |
CN108151765A (zh) | 一种在线实时估计补偿磁强计误差的定位测姿方法 | |
CN104297525A (zh) | 基于火箭橇试验的惯性测量系统加速度计标定方法 | |
Giorgi | Attitude determination | |
CN104296779A (zh) | 基于火箭橇试验的惯性测量系统加速度计迭代补偿方法 | |
CN115540854A (zh) | 一种基于uwb辅助的主动定位方法、设备和介质 | |
CN111650616B (zh) | 一种高精度北斗导航定位系统导航定位参数计算方法 | |
Kis et al. | Development of state estimation system with INS, magnetometer and carrier phase GPS for vehicle navigation |
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 | ||
CB02 | Change of applicant information | ||
CB02 | Change of applicant information |
Address after: 401220 No. 6 Xinmin Road, Xinshi Street, Changshou District, Chongqing Applicant after: Chongqing Zhongyou Huice Communication Technology Co., Ltd. Address before: 401121 Chongqing North New District Yubei District high tech Park mercury science and Technology Development Center North Wing 5 floor Applicant before: Chongqing Zhongyou Huice Communication Technology Co., Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |