CN102508275B - 多天线gps/gf-ins深度组合定姿方法 - Google Patents
多天线gps/gf-ins深度组合定姿方法 Download PDFInfo
- Publication number
- CN102508275B CN102508275B CN201110332881.3A CN201110332881A CN102508275B CN 102508275 B CN102508275 B CN 102508275B CN 201110332881 A CN201110332881 A CN 201110332881A CN 102508275 B CN102508275 B CN 102508275B
- Authority
- CN
- China
- Prior art keywords
- ins
- gps
- attitude
- antenna
- speed
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 61
- 238000004364 calculation method Methods 0.000 claims abstract description 24
- 239000013598 vector Substances 0.000 claims description 54
- 238000004422 calculation algorithm Methods 0.000 claims description 20
- 239000011159 matrix material Substances 0.000 claims description 17
- 238000001914 filtration Methods 0.000 claims description 14
- 238000006243 chemical reaction Methods 0.000 claims description 11
- 230000014509 gene expression Effects 0.000 claims description 11
- 238000009434 installation Methods 0.000 claims description 8
- 238000012937 correction Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 5
- 230000009467 reduction Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 abstract description 10
- 230000004927 fusion Effects 0.000 description 6
- 230000035945 sensitivity Effects 0.000 description 6
- 238000009825 accumulation Methods 0.000 description 4
- 230000008901 benefit Effects 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 238000011160 research Methods 0.000 description 4
- 230000007547 defect Effects 0.000 description 3
- 238000000691 measurement method Methods 0.000 description 3
- 239000000969 carrier Substances 0.000 description 2
- 238000009795 derivation Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000013178 mathematical model Methods 0.000 description 2
- 238000013179 statistical model Methods 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- PEDCQBHIVMGVHV-UHFFFAOYSA-N Glycerine Chemical compound OCC(O)CO PEDCQBHIVMGVHV-UHFFFAOYSA-N 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000002401 inhibitory effect Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种多天线GPS/GF-INS深度组合定姿方法:多天线GPS/GF-INS系统首次运行时,首先由GPS独自工作,独立解算位置、速度以及姿态角;GPS工作稳定后,运用GPS输出的位置、速度和载体的姿态角对GF-INS进行位置、速度以及姿态角初始化;GF-INS初始化完成后,即正常工作开始导航计算,所述多天线GPS/GF-INS系统按预定方法输出位置、速度和姿态角。本发明结构简单,可以大大提高GPS双差整周模糊度的搜索成功率,进而提高GPS系统的姿态测量精度和整个组合导航系统的导航精度和抗干扰能力。
Description
技术领域
本发明涉及组合导航定位定姿领域,具体涉及一种多天线GPS/GF-INS深度组合定姿方法。
背景技术
随着小型无人机、灵巧炮弹、短程导弹等高动态的小型武器对高精度、抗干扰、高可靠性和低成本等导航性能的需求不断提高,而到目前为止,任何单一的导航系统都无法完全满足此需求,因此,能够实现优势互补,进而提高系统的精度、可靠性以及稳定性的组合导航系统成为目前导航领域的研究热点。
惯性导航系统(INS)是一种可独立工作的推航系统。传统的惯性导航系统采用陀螺仪来敏感载体的姿态角速度,然后通过对姿态角速度进行积分来计算姿态角。由于姿态角速度误差会随着积分不断累加,因此,单纯的惯性导航系统很难实现长期高精度的定姿。
无陀螺惯性导航系统(GF-INS)不包含陀螺仪,成本较传统惯性导航系统要低,但加速度计的安装较为复杂,且姿态角的计算也是通过积分的方法,因此同样具有误差随时间累积的缺点。
全球定位系统(GPS)是一种在全球范围内,全天候、实时、连续和高精度的导航系统,已在军事和民用领域获得了广泛应用。多天线(至少3个)双差技术是GPS进行姿态角估计的常用方法之一。
目前,单频、单历元姿态解算成为实时姿态测量系统的研究热点和难点。要实现GPS单历元实时定姿,关键是准确求解该历元的整周模糊度。
带约束的最小二乘降相关平差(CLAMDA)算法是目前最有效的整周模糊度估计算法,但其只能将高精度的浮点解映射到正确的整数解,在浮点解精度不高时,往往会出现错误。针对INS和GPS分别在姿态角解算中存在的以上问题,以及二者在定位定姿方面的优势互补,国内外不少相关的研究者在GPS/INS组合测姿方面开展了研究。
2001年,卡尔加里大学的Yunchun Yang等人提出一种IMU辅助的GPS单频单历元定姿算法,该算法核心思想是利用IMU输出的俯仰角和横滚角对整周模糊度的搜索空间进行约束,从而减少搜索空间的大小。但此算法中俯仰角和横滚角的解算完全依靠IMU,对IMU的精度要求很高,且双差整周模糊度直接根据载波相位残差的平方和最小来确定,很难保证搜索的成功率。
2003年,Yunchun Yang等人又提出一种两天线GPS/INS测姿方法,将由惯性导航系统和GPS系统分别计算出的载波相位、多普勒频率和短基线矢量做差,利用扩展卡尔曼滤波对惯导输出的位置、速度、姿态角以及陀螺和加速度计误差进行估计并补偿。当GPS信号较好时,此方法可显著提高整个系统的定位定姿精度;而当GPS信号较弱时,GPS双差载波相位整周数的估计成功率无法保证,此方法则黯然失色。
2004年,查月等人提出利用信息融合技术(具体应用为联合卡尔曼滤波技术)将GPS和SINS(捷联式惯性导航系统)进行信息融合,在GPS载波相位观测量精度较高的前提下,可以提高整个系统的姿态角测量精度,但是当GPS载波相位观测量精度不高时,姿态角的计算可能出现的错误结果,不仅会影响整个组合导航系统的姿态角测量精度,而且由于信息融合后对SINS进行了反馈矫正,因此,还会影响到SINS下一时刻的导航计算。
2006年,哈尔滨工业大学的卢鸿谦等人提出一种单天线/GPS组合测姿方法,此方法结构简单、成本低,但单天线测姿只能给出协调飞行(即侧滑角为零)情况下的载体姿态,不能实时提供在任意飞行条件下的姿态信息。因此,其应用范围不如多天线定姿系统广泛。
综上所述,目前已有GPS/INS组合测姿方法均着眼于对INS输出姿态角进行补偿,没有解决GPS信号较弱时双差整周模糊度搜索成功率较低的问题。成本较传统惯性导航系统更低的GF-INS系统,由于复杂配置方案下,加速度计的安装和校准难度大,简单配置方案不能全部给出载体的位置、速度和姿态角信息,使得有关GPS/GF-INS组合导航系统的研究和应用受到了限制。
发明内容
本发明的目的在于克服传统多天线GPS/INS定姿方法的不足,而提供一种多天线GPS/GF-INS定姿系统及深度组合定姿方法。
根据本发明的一个方面,提供一种多天线GPS/GF-INS深度组合定姿方法,多天线GPS/GF-INS系统首次运行时,首先由多天线GPS独自工作,利用单频、单历元姿态解算算法求解出载体的三个姿态角;在三天线GPS工作稳定后,应用主天线输出的经度、纬度和高度对GF-INS进行位置初始化,利用GPS输出的三个天线的速度对GF-INS进行速度初始化,利用GPS输出的航向角、俯仰角和横滚角对GF-INS进行姿态角初始化;GF-INS初始化完成后,即正常工作开始导航计算,所述多天线GPS/GF-INS系统按预定方法输出位置、速度和姿态角。
所述GPS天线为3个,包括主天线1,副天线2、3;所述GF-INS包括6个加速度计A1、A2、A3、A4、A5、A6;其中加速度计A1、A4、A6与主天线1安装在一起,A2和A5与副天线2安装在一起,A3与副天线3安装在一起;加速度计A1、A2、A3的敏感方向沿载体坐标系z轴正向,A4和A5的敏感方向沿载体坐标系x轴正向,A6的敏感方向沿载体坐标系y轴正向;所述三根天线分别固连在三个载体上;固连主天线1、副天线2的载体连成的基线与载体纵轴平行,称为主基线;固连主天线1、副天线3的载体连成的基线与载体横轴平行,称为副基线。
所述单频单历元姿态解算算法的步骤具体包括:
(1)GNSS建模:建立卫星的双差载波相位观测方程和码伪距观测方程;
(2)浮点解计算:利用最小二乘法计算基线矢量和载波整周模糊度的浮点解及其方差协方差矩阵;
(3)载波整周模糊度整数解搜索:利用基线约束的最小二乘降相关平差算法搜索载波整周模糊度的整数解;
(4)基线矢量求解:利用最小二乘法由求解出的载波整周模糊度的整数解,解算出基线矢量在地理坐标系下的表达式;
(5)姿态角求解:重复步骤(1)-(4),依次求解主基线矢量和副基线矢量在地理坐标系下的表达式,再由多天线GPS定姿原理求解出载体的三个姿态角。
所述建立卫星的双差载波相位观测方程和码伪距观测方程的步骤包括:
建立选定的某一短基线对于每一颗可观测卫星的单差载波相位观测方程和码伪距观测方程;
选定仰角最大的卫星作为参考星,建立双差载波相位观测方程和码伪距观测方程。
所述GF-INS导航计算包括:
速度更新:通过GF-INS的加速度计输出GPS的天线安装点相应敏感方向的加速度,利用所述加速度对时间的积分值对GF-INS对应位置对应方向的速度进行更新;
位置更新:对更新后的主天线位置的速度进行积分,对GF-INS进行位置更新;
姿态角更新:通过更新后的主天线和副天线相应敏感方向的速度,对基线矢量在地理坐标系相应坐标轴上的投影的线段长度进行更新,进而对三个姿态角进行更新。
所述多天线GPS/GF-INS系统按预定方法输出位置、速度和姿态角包括:
当GPS可观测卫星个数少于2颗时,直接输出GF-INS的位置、速度和姿态角;当GPS可观测卫星个数大于或等于2颗时,GF-INS和GPS系统按预定深度组合方法进行定姿。
所述按预定深度组合方法进行定姿的步骤包括:
当可观测卫星小于4颗时,利用GF-INS输出的位置和速度给GPS的位置和速度赋值;
当可观测卫星大于或等于4颗时,首先利用GPS定位原理解算接收机三个天线的位置和速度,其次通过GF-INS辅助GPS定姿,输出定姿势后的位置、速度和姿态角。
所述通过GF-INS辅助GPS定姿的步骤包括:
建立GF-INS辅助的GPS双差载波相位观测方程;
利用最小二乘法计算基线矢量和载波整周模糊度浮点解及其方差协方差矩阵;
根据所述单频单历元姿态解算算法的步骤(3)-(5)进行载波整周模糊度整数解搜索、基线矢量求解和姿态角计算;
通过组合滤波对GF-INS输出的位置、速度和姿态角反馈矫正后输出。
所述建立GF-INS辅助的GPS双差载波相位观测方程步骤包括:
建立对于选定的某一个短基线的双差载波相位和双差码伪距方程;
由GF-INS输出的姿态角求解出姿态矩阵,结合已知两基线矢量在载体坐标系下的表达式,建立基线矢量从地理坐标系到载体坐标系的转换方程;
联立所述基线矢量转换方程和双差载波相位及双差码伪距方程,建立GF-INS辅助的GPS观测方程。
所述通过组合滤波对GF-INS输出的位置、速度和姿态角反馈矫正后输出的步骤包括:
将GPS和GF-INS输出的位置、速度和姿态角分别做差,作为观测量进行扩展卡尔曼滤波;
估计GF-INS输出的位置、速度和姿态角的误差,对GF-INS输出的位置、速度和姿态角进行反馈矫正;
输出矫正后的位置、速度和姿态角。
本发明与现有技术相比的有益效果体现在:
(1)与现有的INS辅助多天线GPS定姿方法相比,本发明采用不含陀螺仪的GF-INS系统对多天线GPS定姿进行辅助,进一步降低了成本。
(2)本发明提出了一种易于安装的GF-INS加速度计配置方案,将加速度计直接安装在GPS的三个天线上,并设计了针对此方案的姿态角解算方法,即克服了传统加速度计配置方案安装难度大的问题,也解决了简单配置方案下,姿态角的解算需要借助外界信息辅助的难题。
(3)本发明将由GF-INS建立的基线矢量转换方程和双差载波相位及码伪距观测方程联合在一起,增加了观测方程的个数,使得在GPS的可观测卫星个数极少(大于或等于2颗)的情况下,GPS就能够利用单频、单历元算法进行姿态角解算,提高了GPS系统的抗干扰能力;另外,由于增大了方程对未知数的冗余度,也可提高整周模糊度和基线矢量浮点解的精度,从而提高载波整周模糊度的搜索成功率。
(4)本发明采用扩展卡尔曼滤波进行信息融合,建立了不同于传统GPS/INS组合导航系统的系统方程,对GF-INS输出的位置、速度和姿态角进行了误差估计并补偿,一方面抑制了GF-INS系统的误差累积,同时也提高了整个系统的位置、速度和姿态角精度。
设计了一种易于安装的GF-INS加速度计配置方案和针对此配置方案的姿态角计算方法,即降低了成本和加速度计安装复杂度,又解决了简单配置方案的GF-INS需要外界信息辅助才能计算出载体姿态角的问题;利用输出频率较高的GF-INS系统输出的姿态角信息,增加GPS双差观测方程对未知数的冗余度,不仅可通过提高整周模糊度和基线矢量浮点解的精度来提高整周模糊度搜索成功率,而且克服了多天线GPS系统在卫星颗数少于4颗时无法定姿的缺点;利用GPS系统全球全天候的优点,对GF-INS系统进行实时校正,从而抑制了GF-INS系统误差的累积。
附图说明
图1是本发明的GF-INS加速度计和GPS多天线的安装示意图;
图2是本发明的多天线GPS/GF-INS深度组合定姿方法的流程图;
图3是本发明的基于GPS的单频单历元姿态解算算法的流程图;
图4是本发明的GF-INS辅助的GPS单频单历元姿态解算算法的流程图;
图5是本发明的载体航向角示意图。
具体实施方式
如图1所示,本发明实施例中,GF-INS采用一种易于安装的加速度计配置方案,其包括6个加速度计A1、A2、A3、A4、A5、A6;GPS天线为3个:主天线1,副天线2、3,;加速度计A1、A4、A6与主天线1安装在一起,A2和A5与副天线2安装在一起,A3与副天线3安装在一起;加速度计A1、A2、A3的敏感方向沿载体坐标系z轴正向,A4和A5的敏感方向沿载体坐标系x轴正向,A6的敏感方向沿载体坐标系y轴正向;所述三根天线分别固连在三载体上;固连主天线1、副天线2的载体连成的基线与载体纵轴平行,称为主基线;固连主天线1、副天线3的载体连成的基线与载体横轴平行,称为副基线,主基线和副基线长度均为L。
以下结合该GF-INS加速度计与GPS天线的安装方法,对本发明作说明如下:
参见图2所示,该图示出了本发明的多天线GPS/GF-INS深度组合定姿方法的详细流程示意图;
步骤一:GPS系统独自进行位置、速度和姿态角解算;
当多天线GPS/GF-INS系统首次开始工作时(k=0),首先由GPS系统独自进行位置、速度和姿态角的解算。其中,姿态角的解算利用单频单历元姿态解算算法。假设可观测的卫星个数为m,其中m>=4,参见图3,所述单频、单历元姿态解算算法的步骤如下:
1、GNSS建模:建立卫星的双差载波相位和码伪距观测方程;
其具体实施过程如下:
1.1建立每一颗卫星的单差载波相位和码伪距观测方程;
以1、2两个天线为端点的短基线为例,其对于第i颗卫星的单差载波相位观测方程和单差码伪距观测方程分别如式(1)和式(2):
其中,是1、2两个天线到第i颗卫星的单差载波相位的小数部分,是1、2两个天线到第i颗卫星的单差码伪距,是待估计的单差整周模糊度,si是接收机到卫星i的单位矢量,和分别为两个接收机钟差引起的载波相位和码伪距观测误差,和是观测噪声,λ为载波波长。对于m颗卫星而言,则有2m个单差方程。
1.2建立双差载波相位和码伪距观测方程;
假设卫星1仰角最大,作为参考星,则可以得到参考星的单差方程:
式(3)和式(1)以及式(4)和式(2)分别相减后,可得出2(m-1)个双差方程,如下:
将多颗卫星的载波相位观测方程和码伪距观测方程表示成矩阵形式为:
其中,
Q=Em-1+Im-1,Em-1为m-1阶全一矩阵,Im-1为m-1阶单位矩阵。
联合式(7)和式(8),可得载波相位观测方程和码伪距观测方程的组合形式为:
其中方程个数为2(m-1)个,未知数个数为(m+2)个,因此,只有m≥4,(9)式有解。
2、浮点解计算;利用最小二乘法计算基线矢量和载波整周模糊度的浮点解及其方差协方差矩阵;
其具体实施过程如下:
由于载波相位双差存在相关性,会增加求解的难度,因此在利用最小二乘方法前,先进行如下处理。方程(1)的矩阵数学模型如下:
其中P∈Rm×m,e1=(1,0,…,0)T,进一步整理有,
其中, (10)式两边左乘P矩阵,即有
将上式中不含钟差项的部分提取出来,则有
Householder变换并不改变噪声的统计特性,即
容易证明
由(15)和(17)式可以得到
与(10)式类似,得到码伪距单差观测方程
其中,单差码伪距观测向量为
与(18)式类似,得到,
其中,噪声的统计模型为
(21)式等价为如下形式:
(23)式可以看成如下形式:
Y=Ax+w,w~QY (24)
其最小二乘解为:
其方差协方差矩阵:
3、载波整周数模糊度整数解搜索;
运用基线约束的最小二乘降相关平差算法CLAMDA搜索载波整周模糊度整数解。其中带有基线约束的GNSS数学模型是:
E(Y)=AN+Bb,D(Y)=QY,N∈Zn,b∈R3,||b||=L (27)
其中,L为精确测量的基线长度。
设 则CLAMDA算法的目标函数是:
4、基线矢量求解;
利用最小二乘法由求解出的载波整周模糊度的整数解,解算出基线矢量在地理坐标系下的表达式;
将步骤3中求解出的NDD带入(7)式可得:
可重新解出基线矢量在地理坐标系下的表达式的最小二乘解为:
5、求解姿态角;
重复步骤1-4,依次求解主基线矢量和副基线矢量在地理坐标系下的表达式,再由多天线GPS定姿原理求解出载体的三个姿态角。
具体实施步骤为:
步骤二、GF-INS初始化;
当三天线GPS系统工作稳定之后,在k=0时,应用三天线GPS系统输出的位置、速度和载体的姿态角对GF-INS系统进行初始化;
具体为:应用主天线输出的经度、纬度和高度对GF-INS进行位置初始化,利用GPS输出的三个天线的速度对GF-INS进行速度初始化,利用GPS输出的航向角、俯仰角和横滚角对GF-INS进行姿态角初始化;
初始化之后的GF-INS系统即可独立工作。所述GF-INS系统位置、速度、姿态角初始化过程如下:
λI1=λG1,LI1=LG1,hI1=hG1
VI1E=VG1E,VI1N=VG1N,VI1U=VG1U,VI2N=VG2N,VI2U=VG2U,VI3U=VG3U (34)
ψI=ψG,θI=θG,γI=γG
其中,下标I和G分别指GF-INS和GPS,下标1,2,3代表三个天线,E、N、U代表东、北、天,λ、L、h、V分别指经度、纬度、高度和速度,ψ,θ,γ指航向角、俯仰角和横滚角。
GF-INS独立工作的流程如下:
1、速度更新:GF-INS是一个推航系统,其速度更新公式如下:
其中,V0指上一时刻速度,a指对应位置、对应方向的加速度。式(34)中的6个不同位置不同方向的速度均用式(35)进行更新。
2、位置更新:假设地球参考椭球体长半轴为Re,地球扁平系数为f,则卯酉圈上纬度为L的点的曲率半径为RN=Re(1+fsin2L),子午圈上纬度为L的点的曲率半径为RM=Re(1-2f+3fsin2L)。令其中,h为地理高度(以下出现相同符号时,含义同上)。则,GF-INS的位置更新公式为:
其中,λ0,L0,h0分别指上一时刻GF-INS的经度、纬度和高度。
3、姿态角更新:
载体的航向角是指载体纵轴在水平面的投影与地理子午线之间的夹角。若沿载体纵轴方向安装两个敏感方向均为地理北向的加速度计1、2,如图5所示,两加速度计1、2之间的线段长度已知,记为L。
若已知k时刻载体的航向角为ψ0(0≤ψ0≤π/2),则可计算出k时刻两加速度计1、2之间的距离在地理北向的投影线段AB′的长度为Lcos(ψ0),若已知k+1时刻加速度计1和加速度计2安装点在地理北向的速度分别为V1N,V2N,则可计算出k+1时刻线段AB′的长度为:
|AB′|=Lcos(ψ0)+(V1N-V2N)T (37)
其中,T为k+1时刻和k时刻的时间间隔。
再由反三角函数即可计算出k+1时刻的航向角。依此类推,可计算出任意时刻载体的航向角。
同样,已知载体的俯仰角和横滚角的初始值,也可用类似方法计算出载体在任意时刻的俯仰角和横滚角。
因此,可总结出GF-INS姿态角更新公式为:
其中,ψ0,θ0,γ0分别指上一时刻载体的航向角、俯仰角和横滚角。
步骤三、位置、速度和姿态角输出;
GF-INS开始工作以后,当GPS可观测卫星个数少于2颗时,直接输出GF-INS的位置、速度和姿态角;
当GPS可观测卫星大于或等于2颗时,GF-INS和GPS系统将进行深度组合。
所述GF-INS/GPS深度组合方法的流程如下:
当可观测卫星小于4颗时,利用GF-INS输出的位置和速度给GPS系统的位置和速度赋值;
当可观测卫星大于或等于4颗时,先利用GPS定位原理分别解算接收机三个天线的位置和速度;其次通过GF-INS辅助GPS定姿(单频单历元算法解算姿态角),输出定姿势后的位置、速度和载体的姿态角。
参见图4,所述通过GF-INS辅助GPS定姿的具体步骤如下:
1、建立GF-INS辅助的GPS双差载波相位观测方程;
其具体步骤为:
对于选定的某一短基线,首先,在t时刻由系统输出的GPS接收机位置、在t时刻k历元载波相位和码伪距观测值、以及t时刻GF-INS输出的姿态角建立基本的双差载波相位和双差码伪距方程;其次,由t时刻GF-INS输出的姿态角求解出姿态矩阵,再结合已知的两基线矢量在载体坐标系下的表达式,建立基线矢量从地理坐标系到载体坐标系的转换方程;最后,将所述基线矢量转换方程和双差载波相位及双差码伪距方程联立,建立GF-INS辅助的GPS观测方程,即扩大以后的GPS双差观测方程;
设天线1、2确定的基线矢量在地理坐标中的表达式为 在载体坐标系中的表达式为 对于短基线,以下关系式成立:
其中, 称为姿态矩阵。假设载体为刚体,则固定不变,且可通过精确测量获得。将t时刻GF-INS输出的姿态角和通过精确测量得出的代入式(25),即可得基线矢量转换方程。为统一符号,且考虑观测噪声,将式(39)调整为:
其中,ε为载体坐标系下基线矢量的观测噪声。
将式(23)和式(9)联立可得GF-INS辅助的GPS单频单历元观测方程为:
2、利用最小二乘法计算基线矢量和载波整周模糊度浮点解及其方差协方差矩阵;
同(25)式,可计算出基线矢量和载波整周模糊度的浮点解为:
及其方差协方差矩阵:
3、进行载波整周模糊度整数解搜索、基线矢量求解和姿态角计算;
所述载波整周模糊度整数解搜索、基线矢量求解和姿态角计算分别同步骤一中的步骤3、4、和5,不再描述。在搜索载波整周模糊度整数解后输出该整周模糊度整数解,并在k=k+1历元时刻将该整数解输出作为GPS在t时刻k历元载波相位的码伪距观测值进行下一步的计算;
4、通过EKF组合滤波对GF-INS输出的位置、速度和姿态角反馈矫正后输出;
将上述GPS和GF-INS输出的位置、速度和姿态角分别做差,作为观测量进行扩展卡尔曼滤波,估计出GF-INS输出的位置、速度和姿态角的误差,对GF-INS进行反馈矫正,并输出矫正以后的位置、速度和姿态角;
采用扩展卡尔曼滤波(EKF)作为组合滤波器。组合滤波器的观测量为:
z=[LG-LI λG-λI hG-hI θG-θI γG-γI ψG-ψI
VE1G-VE1I VN1G-VN1I VN2G-VN2I VU1G-VU1I VU2G-VU2I VU3G-VU3I]T
其中,θ、γ、φ分别指载体的俯仰角、横滚角和航向角,Ve,Vn和Vu分别指东向、北向和天向速度。下标1,2,3指三个天线,G和I分别代表GPS和GF-INS。
组合滤波器的状态量为:
X=[δL δλ δh δψ δθ δγ δV1E δV1N δV2N δV1U δV2U δV3U]T
其中,δL,δλ,δh,δθ,δγ,δψ,δVE,δVN,δVU分别指GF-INS的位置误差、姿态角误差和东北天三个方向的速度误差。
此组合滤波器的状态方程采用GF-INS的误差传播方程,具体的推导过程如下:
4.1位置和速度误差传播方程。
GF-INS的位置和速度误差传播方程的推导同传统INS,此处不再详述,直接给出位置和速度误差传播方程如下:
经度误差传播方程:
纬度误差传播方程:
高度误差传播方程:
东向速度误差传播方程:
北向速度误差传播方程:
天向速度误差传播方程:
4.2姿态角误差传播方程。
此配置方案下,载体姿态角的递推方程如式(38),(38)式两边对时间t进行微分得到:
对式(53)两端取全微分得航向角误差传播方程为:
俯仰角误差传播方程为:
横滚角误差传播方程为:
本发明未详细阐述的部分属于本领域公知技术。
本发明提出的多天线GPS/GF-INS深度组合定姿方法,根据多天线GPS单频单历元姿态解算方法中对双差整周模糊度搜索成功率不高,且当GPS可观测卫星个数小于4颗时不能进行姿态角解算,现有的INS辅助多天线GPS定姿系统无法提高GPS定姿精度的问题提出的,其中GF-INS采用一种易于安装的加速度计配置方案和特殊的姿态角更新方法,即减少了加速度计安装的复杂度,提高了系统的灵活性,又不需要外界条件的辅助。将由GF-INS输出的姿态角建立的载体坐标系下的基线矢量到地理坐标系下的基线矢量的转换矩阵,与双差载波相位和码伪距方程联立,增大了方程对未知数的冗余度,一方面使得当GPS可观测卫星个数最少为2颗时即可以进行单频单历元解算,另一方面也提高了载波相位双差整周模糊度和基线矢量浮点解的精度,从而可间接提高整周模糊度的搜索成功率。利用扩展卡尔曼滤波,将GPS输出的位置、速度和姿态角与GF-INS输出的位置、速度和姿态角进行信息融合,即进一步提高了整个系统的定位、定姿精度,又抑制了GF-INS系统的误差累积。当GPS信号出现短暂丢失时,可观测卫星个数小于2,GF-INS系统可以独立进行位置、速度和姿态角解算,保证了系统的连续性。
综上所述,本发明提出了一种多天线GPS/GF-INS深度组合定姿方法。提出应用不含陀螺仪的全加速度计惯性导航系统对多天线GPS定姿进行辅助,进一步降低了组合定姿系统的成本;设计一种易于安装的加速度计配置方案,并针对此配置方案设计了一种姿态角更新方法,使GF-INS系统在此简单配置下就可以独立进行位置、速度和姿态角解算,扩大了简单加速度计配置方案的GF-INS系统的应用范围;将由GF-INS输出的姿态角建立的载体坐标系下的基线矢量到地理坐标系下的基线矢量的转换矩阵,与双差载波相位和码伪距方程联立,增大了方程对未知数的冗余度,一方面使得当GPS可观测卫星个数最少为2颗时即可以进行单频单历元解算,另一方面也提高了载波相位双差整周模糊度和基线矢量浮点解的精度,从而可间接提高整周模糊度的搜索成功率;在信息融合方面,建立了不同于传统GPS/INS组合导航系统的系统方程,利用扩展卡尔曼滤波将GF-INS系统的GPS系统的定位以及定姿信息充分融合,即可以抑制GF-INS系统误差随时间累积,又进一步提高了整个系统的位置、速度和姿态角精度。
以上仅是本发明的具体应用范例,对本发明的保护范围不构成任何限制。其可扩展应用于所有组合导航定位、定姿的应用领域,凡采用等同变换或者等效替换而形成的技术方案,均落在本发明权利保护范围之内。
Claims (9)
1.一种多天线GPS/GF-INS深度组合定姿方法,其特征在于:
多天线GPS/GF-INS系统首次运行时,首先由多天线GPS独自工作,利用单频、单历元姿态解算算法求解出载体的三个姿态角;
在三天线GPS工作稳定后,应用主天线输出的经度、纬度和高度对GF-INS进行位置初始化,利用GPS输出的三个天线的速度对GF-INS进行速度初始化,利用GPS输出的航向角、俯仰角和横滚角对GF-INS进行姿态角初始化;GF-INS初始化完成后,即正常工作开始GF-INS导航计算,所述多天线GPS/GF-INS系统按预定方法输出位置、速度和姿态角。
2.根据权利要求1所述的多天线GPS/GF-INS深度组合定姿方法,其特征在于,所述单频单历元姿态解算算法包括:
(1)GNSS建模:建立卫星的双差载波相位观测方程和码伪距观测方程;
(2)浮点解计算:利用最小二乘法计算基线矢量和载波整周模糊度的浮点解及其方差协方差矩阵;
(3)载波整周模糊度整数解搜索:利用基线约束的最小二乘降相关平差算法搜索载波整周模糊度的整数解;
(4)基线矢量求解:利用最小二乘法由求解出的载波整周模糊度的整数解,解算出基线矢量在地理坐标系下的表达式;
(5)姿态角求解:重复步骤(1)-(4),依次求解主基线矢量和副基线矢量在地理坐标系下的表达式,再由多天线GPS定姿原理求解出载体的三个姿态角。
3.根据权利要求2所述的多天线GPS/GF-INS深度组合定姿方法,其特征在于,所述建立卫星的双差载波相位观测方程和码伪距观测方程包括:
建立选定的某一短基线对于每一颗可观测卫星的单差载波相位观测方程和码伪距观测方程;
选定仰角最大的卫星作为参考星,建立双差载波相位观测方程和码伪距观测方程。
4.根据权利要求1所述的多天线GPS/GF-INS深度组合定姿方法,其特征在于,所述GF-INS导航计算包括:
速度更新:通过GF-INS的加速度计输出GPS的天线安装点相应敏感方向的加速度,利用所述加速度对时间的积分值对GF-INS对应位置对应方向的速度进行更新;
位置更新:对更新后的主天线位置的速度进行积分,对GF-INS进行位置更新;
姿态角更新:通过更新后的主天线和副天线相应敏感方向的速度,对基线矢量在地理坐标系相应坐标轴上的投影的线段长度进行更新,进而对三个姿态角进行更新。
5.根据权利要求1所述的多天线GPS/GF-INS深度组合定姿方法,其特征在于,所述多天线GPS/GF-INS系统按预定方法输出位置、速度和姿态角包括:
当GPS可观测卫星个数少于2颗时,直接输出GF-INS的位置、速度和姿态角;当GPS可观测卫星个数大于或等于2颗时,GF-INS和GPS系统按预定深度组合方法进行定姿。
6.根据权利要求5所述的多天线GPS/GF-INS深度组合定姿方法,其特征在于,所述按预定深度组合方法进行定姿的步骤包括:
当可观测卫星小于4颗时,利用GF-INS输出的位置和速度给GPS的位置和速度赋值;
当可观测卫星大于或等于4颗时,首先利用GPS定位原理解算接收机三个天线的位置和速度,其次通过GF-INS辅助GPS定姿,输出定姿势后的位置、速度和姿态角。
7.根据权利要求6所述的多天线GPS/GF-INS深度组合定姿方法,其特征在于,所述通过GF-INS辅助GPS定姿的步骤包括:
建立GF-INS辅助的GPS双差载波相位观测方程;
利用最小二乘法计算基线矢量和载波整周模糊度浮点解及其方差协方差矩阵;
根据权利要求3所述的步骤(3)-(5)进行载波整周模糊度整数解搜索、基线矢量求解和姿态角计算;
通过组合滤波对GF-INS输出的位置、速度和姿态角反馈矫正后输出。
8.根据权利要求7所述的多天线GPS/GF-INS深度组合定姿方法,其特征在于,所述建立GF-INS辅助的GPS双差载波相位观测方程包括:
建立对于选定的某一个短基线的双差载波相位和双差码伪距方程;
由GF-INS输出的姿态角求解出姿态矩阵,结合已知两基线矢量在载体坐标系下的表达式,建立基线矢量从地理坐标系到载体坐标系的转换方程;
联立所述基线矢量转换方程和双差载波相位及双差码伪距方程,建立GF-INS辅助的GPS观测方程。
9.根据权利要求7所述的多天线GPS/GF-INS深度组合定姿方法,其特征在于,所述通过组合滤波对GF-INS输出的位置、速度和姿态角反馈矫正后输出包括:
将GPS和GF-INS输出的位置、速度和姿态角分别做差,作为观测量进行扩展卡尔曼滤波;
估计GF-INS输出的位置、速度和姿态角的误差,对GF-INS输出的位置、速度和姿态角进行反馈矫正;
输出矫正后的位置、速度和姿态角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110332881.3A CN102508275B (zh) | 2011-10-28 | 2011-10-28 | 多天线gps/gf-ins深度组合定姿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110332881.3A CN102508275B (zh) | 2011-10-28 | 2011-10-28 | 多天线gps/gf-ins深度组合定姿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102508275A CN102508275A (zh) | 2012-06-20 |
CN102508275B true CN102508275B (zh) | 2013-06-19 |
Family
ID=46220381
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110332881.3A Expired - Fee Related CN102508275B (zh) | 2011-10-28 | 2011-10-28 | 多天线gps/gf-ins深度组合定姿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102508275B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3446154A4 (en) * | 2016-04-22 | 2020-01-01 | Novatel, Inc. | SYSTEM AND METHOD FOR LONG BASE BASED GNSS ACCELEROMETER / NAVIGATION |
Families Citing this family (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103235328B (zh) * | 2013-04-19 | 2015-06-10 | 黎湧 | 一种gnss与mems组合导航的方法 |
CN103389502B (zh) * | 2013-07-29 | 2015-05-27 | 中国人民解放军国防科学技术大学 | 基于多个地面基站高精度确定载体加速度的方法 |
CN103454664B (zh) * | 2013-08-20 | 2016-02-24 | 中国人民解放军国防科学技术大学 | 一种基于陀螺测量信息约束的gnss载波相位模糊度求解方法 |
CN103728641B (zh) * | 2013-12-27 | 2016-06-01 | 苍穹数码技术股份有限公司 | 基于北斗系统的三天线阵高精度定向方法及系统 |
JP6360199B2 (ja) * | 2014-12-26 | 2018-07-18 | 古野電気株式会社 | 状態算出装置、状態算出方法、および状態算出プログラム |
CN104731105A (zh) * | 2015-01-21 | 2015-06-24 | 广州中海达定位技术有限公司 | 基于Smart Heading农机导航入线装置及方法 |
CN104792336B (zh) * | 2015-03-31 | 2019-01-25 | 北京航空航天大学 | 一种飞行状态测量方法及装置 |
CN104835353A (zh) * | 2015-05-04 | 2015-08-12 | 南京邮电大学 | Vanet中基于ins和gnss伪距双差的协作相对定位方法 |
CN106896389B (zh) * | 2015-12-18 | 2019-06-28 | 大唐半导体设计有限公司 | 一种卫星导航接收机的定位定速解算方法 |
CN105807293B (zh) * | 2016-05-27 | 2019-04-16 | 重庆卓观科技有限公司 | 基于soc的单板多天线定姿接收机 |
CN106595656B (zh) * | 2016-12-29 | 2019-09-10 | 辽宁工程技术大学 | 一种基于车载pos的公路线形特征识别与参数计算方法 |
CN107248891B (zh) * | 2017-06-13 | 2023-08-04 | 施浒立 | 一种用于移动通信天线指向监测的测向测姿装置 |
CN107390250B (zh) * | 2017-07-14 | 2019-10-25 | 重庆重邮汇测通信技术有限公司 | 一种基于惯性导航系统和双天线gps的定位测姿方法 |
CN107797131A (zh) * | 2017-09-25 | 2018-03-13 | 华南理工大学 | 基于gps载波相位姿态的无人船数据融合姿态测量方法 |
CN107589432A (zh) * | 2017-10-16 | 2018-01-16 | 驭势科技(北京)有限公司 | 基于天线阵列的卫星导航算法、导航系统和车辆 |
CN108732602B (zh) * | 2018-07-31 | 2021-08-03 | 太原理工大学 | 一种结合综合信息的部分模糊度固定方法 |
CN109143303B (zh) * | 2018-09-03 | 2021-04-20 | 河北雄安远度科技有限公司 | 飞行定位方法、装置及固定翼无人机 |
CN108680942B (zh) * | 2018-09-07 | 2018-12-07 | 湖南天羿领航科技有限公司 | 一种惯性/多天线gnss组合导航方法及装置 |
JP7223542B2 (ja) * | 2018-10-03 | 2023-02-16 | 古野電気株式会社 | 航法装置、航行支援情報の生成方法、および、航行支援情報の生成プログラム |
CN111366151A (zh) * | 2018-12-26 | 2020-07-03 | 北京信息科技大学 | 一种极地范围船舶导航的信息融合方法 |
CN110095117A (zh) * | 2019-05-15 | 2019-08-06 | 南京理工大学 | 一种无陀螺惯性量测系统与gps组合的导航方法 |
CN111694040B (zh) * | 2020-04-08 | 2023-02-07 | 中国人民解放军战略支援部队信息工程大学 | 一种卫星/惯性组合导航系统定位方法与装置 |
CN113237456B (zh) * | 2021-05-31 | 2022-10-28 | 西南电子技术研究所(中国电子科技集团公司第十研究所) | 动中通天线初始安装角测量方法 |
CN113391336A (zh) * | 2021-06-17 | 2021-09-14 | 上海联适导航技术股份有限公司 | 一种航向角的检测方法、装置、设备及可读存储介质 |
CN114355422A (zh) * | 2021-12-14 | 2022-04-15 | 中船航海科技有限责任公司 | 一种基于姿态辅助的多天线定位系统及定位方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6175807B1 (en) * | 1999-06-09 | 2001-01-16 | Litton Systems, Inc. | Temperature compensation method for strapdown inertial navigation systems |
CN2901249Y (zh) * | 2005-05-12 | 2007-05-16 | 吉林大学 | 汽车运动状态测量系统 |
CN101819041A (zh) * | 2010-04-16 | 2010-09-01 | 北京航空航天大学 | 自进化anfis与ukf结合的gps/mems-ins组合定位误差动态预测方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100419380C (zh) * | 2007-01-05 | 2008-09-17 | 北京航空航天大学 | 一种高集成度mimu/gps/微磁罗盘/气压高度计组合导航系统 |
CN100476452C (zh) * | 2007-02-28 | 2009-04-08 | 北京航空航天大学 | 一种机载双天线双测量装置干涉sar基线运动测量方法 |
CN101319902B (zh) * | 2008-07-18 | 2010-09-08 | 哈尔滨工程大学 | 一种低成本组合式定位定向装置及组合定位方法 |
-
2011
- 2011-10-28 CN CN201110332881.3A patent/CN102508275B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6175807B1 (en) * | 1999-06-09 | 2001-01-16 | Litton Systems, Inc. | Temperature compensation method for strapdown inertial navigation systems |
CN2901249Y (zh) * | 2005-05-12 | 2007-05-16 | 吉林大学 | 汽车运动状态测量系统 |
CN101819041A (zh) * | 2010-04-16 | 2010-09-01 | 北京航空航天大学 | 自进化anfis与ukf结合的gps/mems-ins组合定位误差动态预测方法 |
Non-Patent Citations (10)
Title |
---|
丛丽.一种基于GPS单差模型的姿态解算算法.《哈尔滨工业大学学报》.2011,第43卷(第9期), * |
丛丽.新的GPS单频单历元定姿算法.《北京航空航天大学学报》.2011,第37卷(第9期), * |
周红进 * |
宋艳君 * |
王秀森 * |
秦红磊 * |
许江宁.GFINS与GPS扩展松组合导航方法.《中国惯性技术学报》.2011,第19卷(第3期), * |
郭宁博.自适应滤波在GFSINS/GPS组合导航系统中的应用研究.《飞行力学》.2009,第27卷(第2期), * |
金天 * |
陈万通 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3446154A4 (en) * | 2016-04-22 | 2020-01-01 | Novatel, Inc. | SYSTEM AND METHOD FOR LONG BASE BASED GNSS ACCELEROMETER / NAVIGATION |
Also Published As
Publication number | Publication date |
---|---|
CN102508275A (zh) | 2012-06-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102508275B (zh) | 多天线gps/gf-ins深度组合定姿方法 | |
CN106443746B (zh) | 一种低成本双天线gnss/ahrs组合测姿方法 | |
CN109556632B (zh) | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 | |
US9423509B2 (en) | Moving platform INS range corrector (MPIRC) | |
CN102829777B (zh) | 自主式水下机器人组合导航系统及方法 | |
CN102169184B (zh) | 组合导航系统中测量双天线gps安装失准角的方法和装置 | |
CN113203418B (zh) | 基于序贯卡尔曼滤波的gnssins视觉融合定位方法及系统 | |
CN105091907B (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
CN106643709B (zh) | 一种海上运载体的组合导航方法及装置 | |
EP2927640B1 (en) | Global positioning system (gps) self-calibrating lever arm function | |
CN103235328A (zh) | 一种gnss与mems组合导航的方法 | |
Cai et al. | Multi-antenna GNSS and INS integrated position and attitude determination without base station for land vehicles | |
CN101825467A (zh) | 捷联惯性导航系统与天文导航系统实现组合导航的方法 | |
US20110153266A1 (en) | Augmented vehicle location system | |
CN113701751B (zh) | 一种基于多波束天线的导航装置 | |
CN102095424A (zh) | 一种适合车载光纤航姿系统的姿态测量方法 | |
CN102508280A (zh) | 陀螺辅助双天线测量单元确定整周模糊度和航向的方法 | |
CN105910623B (zh) | 利用磁强计辅助gnss/mins紧组合系统进行航向校正的方法 | |
CN108151765B (zh) | 一种在线实时估计补偿磁强计误差的定位测姿方法 | |
CN108225312B (zh) | 一种gnss/ins松组合中杆臂估计以及补偿方法 | |
CN113503892A (zh) | 一种基于里程计和回溯导航的惯导系统动基座初始对准方法 | |
CN116222551A (zh) | 一种融合多种数据的水下导航方法及装置 | |
Du et al. | Integration of PPP GPS and low cost IMU | |
Zhang et al. | Carrier-phase-based initial heading alignment for land vehicular MEMS GNSS/INS navigation system | |
CN112525204B (zh) | 一种航天器惯性和太阳多普勒速度组合导航方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20130619 Termination date: 20211028 |