CN104375157B - 短基线下惯导辅助的北斗单频整周模糊度求解方法 - Google Patents

短基线下惯导辅助的北斗单频整周模糊度求解方法 Download PDF

Info

Publication number
CN104375157B
CN104375157B CN201410568818.3A CN201410568818A CN104375157B CN 104375157 B CN104375157 B CN 104375157B CN 201410568818 A CN201410568818 A CN 201410568818A CN 104375157 B CN104375157 B CN 104375157B
Authority
CN
China
Prior art keywords
big dipper
matrix
satellite
integer ambiguity
inertial navigation
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
Application number
CN201410568818.3A
Other languages
English (en)
Other versions
CN104375157A (zh
Inventor
曹越
李荣冰
林雪原
刘建业
赖际舟
曾庆化
韩志凤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN201410568818.3A priority Critical patent/CN104375157B/zh
Publication of CN104375157A publication Critical patent/CN104375157A/zh
Application granted granted Critical
Publication of CN104375157B publication Critical patent/CN104375157B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial

Abstract

本发明公开了一种短基线下惯导辅助的北斗单频整周模糊度求解方法,分为3个步骤:首先,针对北斗星座类型的轨道高度将北斗观测量进行分组差分,该方法能有效消除短基线下北斗观测量中的大气延时误差;接着,利用惯导输出姿态阵估算基线矢量并代入北斗双差载波观测方程,利用递推最小二乘法计算整周模糊度浮点解和浮点解的协方差矩阵,再采用改进最小二乘模糊度去相关方法固定整周模糊度整数解;最后,利用惯导估算的基线矢量和北斗三差载波相位观测值一起构造检验量判断周跳的发生,若发生则估算周跳值并进行修复。该方法能有效提高整周模糊度的求解速率和精度,适用于在单频北斗卫星系统条件下对高动态载体进行定位定姿。

Description

短基线下惯导辅助的北斗单频整周模糊度求解方法
技术领域
本发明属于单频北斗卫星系统求解整周模糊度优化方法的技术领域,涉及一种结合北斗二代导航的新特点,利用惯导输出姿态阵辅助北斗单频整周模糊度求解、周跳的探测和修复的优化方法。
背景技术
载波整周模糊度的求解以及周跳的探测和修复是卫星导航高精度定位定姿的核心问题。目前,卫星精密定位定姿技术主要针对GPS卫星系统,随着我国北斗卫星的建设,北斗二代已经进入快速组网阶段,我国北斗二代已经发射16颗北斗卫星导航卫星入轨,形成区域服务能力,从国防建设的角度出发,不依赖国外的卫星导航系统,对具有自主性的北斗导航系统研究精密测量技术具有极大的战略意义。
整周模糊度的求解、周跳的探测和修复是卫星导航高精度定位定姿的核心问题。多年来,针对单频整周模糊度的求解,国内外学者提出了许多经典的解算方法,包括模糊度函数法,最小二乘搜索法,最小二乘模糊度去相关法(LAMBDA法)等。其中LAMBDA算法应用最广,但它需要积累较多的历元才能确定整周模糊度,会影响定姿的实时性,周跳探测和修复方法较复杂,并且灵敏度不高,卫星导航载波相位定位定姿系统严重依赖于接收机跟踪性能,鲁棒性差,比如在车载应用环境下,车辆通过立交桥或者周围树木、建筑物对接收机天线的部分遮挡在完全不影响导航定位的情况下,也可导致整周模糊度失效,进而进行重新搜索,最终,无法确保姿态信息的高精度、连续输出。而在载体运动的情况下,多天线载波相位差分姿态系统搜索到整周模糊度的概率相当小。此外,北斗二代星座与GPS、Galileo卫星在有着不同的特点:1、北斗二代星座有三种,而其他卫星星座的种类只有一种;2、北斗二代卫星比GPS、Galileo星座的平均轨道值要大,不利于整周模糊度的解算。针对北斗二代星座的这些特点开展整周模糊度算法的研究是十分必要的。卫星导航整周模糊度技术的上述不足,直接影响了北斗卫星导航精密测量技术的实际应用。
发明内容
发明目的:针对北斗二代特点,克服传统单频整周模糊度(LAMBDA)法实时性不高的缺陷和周跳探测和修复灵敏度不高的缺陷,本发明提供一种短基线下惯导辅助的北斗单频整周模糊度求解方法。
技术方案:为实现上述目的,本发明采用的技术方案为:
一种短基线下惯导辅助的北斗单频整周模糊度求解方法,包括如下步骤:
步骤一、信息初始化,采集北斗原始观测量并计算北斗双差观测量,为有效消除北斗双差观测量的大气延时误差,将北斗系统输出的北斗原始观测量按照北斗星座类型的轨道高度分组差分,从而得到北斗双差载波相位观测值以及北斗卫星到接收机的双差单位矢量,构造北斗双差载波观测方程;
步骤二、利用惯导输出姿态矩阵、平台误差角信息以及天线配置信息估算基线矢量地心地固坐标(ECEF坐标)以及相应的基线矢量方差阵矩阵;
步骤三、将步骤二得到的惯导估算基线矢量代入步骤一中的北斗双差载波观测方程,利用递推最小二乘法求解整周模糊度浮点解及其协方差矩阵;
步骤四、根据步骤三得到的整周模糊度浮点解及其协方差矩阵利用改进最小二乘模糊度去相关方法固定整周模糊度整数解;
步骤五、利用惯导估算基线矢量结合北斗三差载波观测值一起构造检验量判断周跳是否发生,若发生周跳则利用检验量取整的方式估算周跳值并对整周模糊度进行修复。
所述步骤一中,为有效消除北斗双差观测量的大气延时误差,将北斗系统输出的北斗原始观测量按照北斗星座类型的高度进行分组差分:MEO卫星一组,卫星数量为n,取仰角最大的MEO卫星为基准;IGSO卫星和GEO卫星一组,卫星数量为m,取仰角最大的IGSO/GEO卫星作为基准;构造北斗双差载波观测方程如下:
其中,为第j颗MEO卫星到基准MEO卫星(在MEO卫星组中标记为第1颗MEO卫星)的双差载波观测相位,为第j颗IGSO卫星/GEO卫星到基准IGSO卫星/GEO卫星(在IGSO卫星和GEO卫星组中标记为第1颗IGSO卫星/GEO卫星)的双差载波观测相位,为MEO卫星到载体之间的单位矢量,为GEO卫星/IGSO卫星到载体之间的单位矢量,为第j颗MEO卫星到基准MEO卫星的双差整周模糊度,为第j颗IGSO卫星/GEO卫星到基准IGSO卫星/GEO卫星的双差整周模糊度,为第j颗MEO卫星到基准MEO卫星的双差观测噪声,为第j颗IGSO卫星/GEO卫星到基准IGSO卫星/GEO卫星的双差观测噪声,λ为北斗B1频率信号的载波波长,为基线矢量。
所述步骤二中,利用惯导输出姿态矩阵、平台误差角信息以及天线配置信息估算基线矢量地心地固坐标及相应的基线矢量方差矩阵为:
X I = C n e C b n X G = C n e C ^ b n ( I - φ × ) X G
cov [ X I ] = C n e C ^ b n X G × cov [ φ φ T ] [ X G b × ] T [ C ^ b n ] T [ C n e ] T
其中,XI为惯导估算基线矢量,XG为北斗天线构成的基线在机体坐标系内的向量;为理想姿态矩阵,为惯导实际输出的机体坐标系到地理坐标系的姿态矩阵,为地理坐标系到地心地固坐标系的转换矩阵,φ为平台误差角向量,cov[φφT]为平台误差角方差阵,I为单位矩阵,cov[XI]为惯导估算基线矢量的协方差矩阵。
所述步骤四中,根据步骤三得到的整周模糊度浮点解及其协方差矩阵利用改进最小二乘模糊度去相关法固定整周模糊度整数解,包括:
(41)将整周模糊度浮点解协方差矩阵中的正对角线元素先进行顺序排序,再对排序后的协方差矩阵进行LDLT分解,得到整周模糊度去相关变换矩阵;
(42)利用整周模糊度去相关变换矩阵使整周模糊度去相关,然后结合整周模糊度的搜索条件固定整周模糊度整数解。
所述步骤四中,整周模糊度去相关变换矩阵获取方法如下:
(411)确定排序矩阵P,首先将矩阵P设定为与矩阵维数相同的零矩阵,然后将整周模糊度协方差矩阵中的正对角线元素Qii按升序排列,若Qii在排序后位于矩阵对角线元素的第m位,则令矩阵P中的元素Pmi=1,否则为零,计算得到矩阵P中所有元素的值后,计算排序后的矩阵其中i=1、2、…,m=1、2、…;
(412)然后对排序后的矩阵QP进行LDLT整数分解,得到下三角矩阵L后代入到Q=[L]-1QP[LT]-1中进行计算;
(413)基于(411)和(412)两个步骤,不断地进行迭代,直到矩阵[L]-1为或近似为单位阵结束;最终可以得到整周模糊度去相关变换矩阵为:Z=[L1]-1P1[L2]-1P2…[Lk]-1Pk
所述步骤五中,利用惯导估算基线矢量集合北斗三差载波观测量一起构造检验量判断周跳是否发生,若发生周跳则利用检验量取整的方式估算周跳值并对整周模糊度进行修复,其中构造的检验量为:
T=(B(tk)·△b(tk+1,tk)-△y(tk+1,tk))/λ
其中,△y(tk+1,tk)=y(tk+1)-y(tk),y(tk)为tk时刻的北斗三差载波观测量;△b(tk+1,tk)=b(tk+1)-b(tk),b(tk)和b(tk+1)用惯导估算基线矢量代替, b ( t k ) = X I ( t k ) = C n e C ^ b n ( t k ) [ I - φ ( t k ) × ] X G , b ( t k + 1 ) = X I ( t k + 1 ) = C n e C ^ b n ( t k + 1 ) [ I - φ ( t k + 1 ) × ] X G ; B(tk)为tk时刻对应分组的设计矩阵,
若检验量T的绝对值大于1/2,则发生周跳,用检验量T四舍五入取整来计算发生周跳的数目。
有益效果:本发明提供的短基线下惯导辅助的北斗单频整周模糊度求解方法,针对北斗导航系统特点将北斗原始观测量按照北斗星座类型的轨道高度进行分组差分,距离地面高度相近的卫星星座作为一组,能够有效消除北斗双差观测量中的大气延时误差,并且加入惯导辅助的方式,利用惯导输出姿态阵估算基线矢量信息辅助求解整周模糊度浮点解,求解北斗双差载波观测方程的方式为递推最小二乘法,相比于传统的最小二乘法模糊度去相关方法,可以提高整周模糊度的解算速率和精度;此外,利用惯导估算基线矢量和北斗三差载波观测值一起构造检验量进行周跳的探测和修复,相比于传统方法简单且十分灵敏;本方法适用于单频北斗导航系统对高动态载体姿态进行定位或定姿。
附图说明
图1为本发明的原理流程示意图;
图2为本发明惯导辅助求解整周模糊度浮点解精度的示意图;
图3为本发明在20历元发生1周的周跳,80历元发生4周的周跳检验量仿真结果;当检验量均值为0,最大噪声不超过0.25周,表明无周跳发生;可以看出检验量在双差历元为19和20发生大小相等并且方向相反的跳变,因为横坐标为相邻两个历元作差,可以判定载波相位在20历元发生一周的跳变,说明通过检验量能很灵敏的检测出1周的周跳;同理可以看出双差历元值为79和80时发生大小相等、方向相反的跳变,可以判定载波相位在80历元处发生5周的跳变。
具体实施方式
下面结合附图对本发明作更进一步的说明。
如图1所示为一种单频北斗导航系统固定整周模糊度的求解方法,方法整体的流程如图1所示。首先,将北斗接收机输出的北斗原始观测量按照北斗星座类型的轨道高度进行分组差分得到北斗双差观测量和北斗双差载波观测方程,同时存储惯导输出姿态矩阵。接着,进行整周模糊度整数解的固定:首先利用惯导输出姿态矩阵估算基线矢量的地心地固坐标以及相应的基线矢量方差矩阵,再将惯导估算基线矢量代入北斗双差载波观测方程并利用递推最小二乘法计算整周模糊度浮点解及其协方差矩阵,接着利用改进最小二乘模糊度去相关法固定整周模糊度整数解,并进行整周模糊度ratio值检验。最后,利用惯导估算基线矢量以及北斗三差载波观测量一起构造检验量进行周跳的探测和修复。
下面结合具备惯导辅助的B1频信号北斗系统为例进行说明。
短基线下惯导辅助的北斗单频整周模糊度求解方法,包括如下步骤:
一、初始信息获取
(1)为有效消除北斗双差观测量的大气延时误差,将北斗系统输出的北斗原始观测量按照北斗星座类型的轨道高度分组差分:MEO卫星一组,卫星数量为n,选其中仰角最大的一颗MEO卫星作为基准;IGSO卫星和GEO卫星一组,卫星数量为m,选其中仰角最大的一颗IGSO卫星/GEO卫星作为基准,构造北斗双差载波观测方程如下:
其中,为第j颗MEO卫星到基准MEO卫星(在MEO卫星组中标记为第1颗MEO卫星)的双差载波观测相位,为第j颗IGSO卫星/GEO卫星到基准IGSO卫星/GEO卫星(在IGSO卫星和GEO卫星组中标记为第1颗IGSO卫星/GEO卫星)的双差载波观测相位,为MEO卫星到载体之间的单位矢量,为GEO卫星/IGSO卫星到载体之间的单位矢量,为第j颗MEO卫星到基准MEO卫星的双差整周模糊度,为第j颗IGSO卫星/GEO卫星到基准IGSO卫星/GEO卫星的双差整周模糊度,为第j颗MEO卫星到基准MEO卫星的双差观测噪声,为第j颗IGSO卫星/GEO卫星到基准IGSO卫星/GEO卫星的双差观测噪声,λ为北斗B1频率信号的载波波长,为基线矢量。
(2)利用惯导输出姿态矩阵、平台误差角和天线配置信息估算基线矢量地心地固坐标及相应的基线矢量方差矩阵:
X I = C n e C b n X G = C n e C ^ b n ( I - φ × ) X G = C n e ( C ^ b n X G - C ^ b n φ × X G ) = C n e C ^ b n X G × φ
cov [ X I ] = C n e C ^ b n X G × cov [ φ φ T ] [ X G b × ] T [ C ^ b n ] T [ C n e ] T
式中,XI为惯导估算基线矢量(ECEF坐标,地心地固坐标),XG为北斗天线构成的基线在机体坐标系内的向量,为理想姿态矩阵(机体系到地理系的转换矩阵),为惯导实际输出的姿态矩阵,为地理坐标系到地球坐标系的转换矩阵,φ为平台误差角向量,cov[φφT]是平台误差角方差阵(由组合滤波中的方差矩阵获得),I为单位矩阵,cov[XI]为惯导估算基线矢量的方差矩阵。
二、整周模糊度的确认
(3)将由步骤(2)得到的惯导估算基线矢量XI代入步骤(1)得到的北斗双差载波观测方程中,利用递推最小二乘法求整周模糊度浮点解及其协方差矩阵。
(31)将惯导估算基线矢量XI代入北斗双差载波观测方程中,变为:
将上述两式均简化为R=-λa+v;其中,a为对应分组的整周模糊度矢量,v为对应分组的测量噪声。
(32)将用惯导估算基线矢量XI来代替,R=-λa+v左侧R的协方差矩阵为:
(33)对整周模糊度矢量a进行递推最小二乘估计,得到整周模糊度浮点解为:
a ^ k + 1 = a ^ k - Q k + 1 · λ · P L - 1 · ( R + λ · a ^ k )
整周模糊度浮点解的协方差矩阵为:
Q k + 1 = ( Q k - 1 + λ 2 · P L - 1 ) - 1
其中,为整周模糊度浮点解的递推解,Qk为整周模糊度浮点解的协方差矩阵的递推解,PL为北斗原始观测量的方差矩阵。
(4)利用排序白化算法对整周模糊度浮点解进行整数Z变换,使得整周模糊度浮点解去相关。
(41)确定排序矩阵P,首先将矩阵P设定为与矩阵维数相同的零矩阵,然后将整周模糊度协方差矩阵中的正对角线元素Qii按升序排列,若Qii在排序后位于矩阵对角线元素的第m位,则令矩阵P中的元素Pmi=1,否则为零,计算得到矩阵P中所有元素的值后,计算排序后的矩阵其中i=1、2、…,m=1、2、…;
举例来说,初始时 Q a ^ = 85 10 30 10 2 4 30 4 12 , 首先设定 P = 0 0 0 0 0 0 0 0 0 , 然后将中的正对角线元素进行升序排序,得到顺序为Q22、Q33、Q11,那么:位于第m=1位的元素i取值为2,则P12=1;位于m=2位的元素i取值为3,则P23=1;位于第m=3位的元素i取值为1,则P31=1;最终得到 P = 0 1 0 0 0 1 1 0 0 , 计算得到 Q s ^ = 2 4 10 4 12 30 10 30 85 .
(42)对排序后的矩阵QP进行LDLT整数分解,得到下三角矩阵L后代入到Q=[L]-1QP[LT]-1中进行计算。
(43)基于(41)和步骤(42)两个步骤,不断地进行迭代,直到矩阵[L]-1为或近似为单位矩阵结束;最终得到整周模糊度去相关变换矩阵为:Z=[L1]-1P1[L2]-1P2…[Lk]-1Pk,则Z变换后的整周模糊度浮点解为其中k为迭代次数,Li为第i次迭代得到的L,Pi为第i次迭代得到的P。
(5)利用Z变换使整周模糊度浮点解去相关后,利用序贯最小二乘的方法搜索整周模糊度整数解。
(51)确定整周模糊度整数解的搜索范围:对Z变换后的整周模糊度浮点解进行取整,得到最接近的整数矢量z0。将z0中的某一个元素保持不变,该元素以外的其他对应元素取次接近于的整数值,得到一个矢量c,矢量c中的元素包括该不变元素以及其他元素取次接近整数的值并保持位置对应;重复该步骤直至z0中所有元素均有且只有一次保持不变的计算机会,得到对应z0中元素个数的矢量c;将所有得到的矢量c分别带入到公式中得到计算值,取其中次小的计算值作为搜索边界χ2的值, Q z ^ = Z T Q a ^ Z .
举例来说,Z变换后的若整周模糊度那么z0=[1,3,6],分别取z0中的一个元素保持不变,得到三个c值,分别为[1,4,5]、[2,3,5]和[2,4,6],将三个c值分别带入到中进行计算,以得到χ2
(52)将整周模糊度整数解的搜索条件表示为其中z为待搜索的整周模糊度整数解。
将n和m统一使用s进行表示,对进行LDLT分解,可以变为:
Σ i = 1 s - 1 d i [ ( z i - z ^ i ) + Σ j = i + 1 s - 1 l ji ( z j - z ^ j ) ] 2 ≤ χ 2
式中,lji是LDLT分解中矩阵L的元素,di是LDLT分解中矩阵D中正对角线上的元素,而且表示的方差,表示已知的情况下对zi的估计,将整周模糊度整数解的搜索条件表示为 Σ i = 1 s - 1 ( z i - z ^ i | i + 1 , . . . , s - 1 ) 2 σ z ^ i | i + 1 , . . . , s - 1 2 ≤ χ 2 .
(53)对χ2进行序贯条件方差调整,可以得到每一个整周模糊度整数解zj对应的搜索边界,具体方法如下:
第s-1个整周模糊度整数解的搜索边界为:第s-2个整周模糊度整数解的搜索边界为: ( z s - 2 - z ^ s - 2 | s - 1 ) 2 ≤ σ z ^ s - 2 | s - 1 2 [ χ 2 - ( z s - 1 - z ^ s - 1 ) 2 / σ z ^ s - 1 2 ] , ……,第一个整周模糊度整数解的搜索边界为: ( z 1 - z ^ 1 | 2 , . . . , s - 1 ) 2 ≤ σ z ^ 1 | 2 , . . . , s - 1 2 [ χ 2 - Σ j = 2 s - 1 ( z j - z ^ j | j + 1 , . . . , s - 1 ) 2 / σ z ^ j | j + 1 , . . . , s - 1 2 ] , 搜索顺序是zs-1,zs-2,…,z1
(6)将搜索得到的整周模糊度整数解z作为整周模糊度整数解的最优解通过Z变换的逆变换得到整周模糊度的最优解为
(7)将获得的整周模糊度的最优解通过ratio法进行检验,判断是否成立,若成立则整周模糊度的最优解成功固定,其中Ω1为最小残差平方和;Ω2为次小残差平方和;ratio为阈值,由经验确定。
三、周跳的探测和修复
(8)利用惯导估算基线矢量XI结合北斗三差载波观测值构造检验量,根据检验量大小判断周跳是否发生,若发生则利用检验量取整的方式估算周跳值并进行修复。
(81)将步骤(1)中的北斗双差载波相位载波观测方程变换为:
y=Bb-λa+ε
其中,B为对应分组的设计矩阵b为基线矢量,λ为北斗B1频率信号的载波波长,a为对应分组的整周模糊度矢量,v为对应分组的测量噪声。
(82)将两个相邻时刻的北斗双差载波观测方程相减以得到北斗三差观测方程:
△y(tk+1,tk)=y(tk+1)-y(tk)=B(tk+1)b(tk+1)-λa(tk+1)+ε(tk+1)-[B(tk)b(tk)-λa(tk)+ε(tk)]
其中,y(tk)表示tk时刻的北斗三差载波观测量,B(tk)表示tk时刻的设计矩阵,b(tk)表示tk时刻的基线矢量,a(tk)表示tk时刻的整周模糊度,ε(tk)表示tk时刻的测量噪声。
将相邻时刻载体到卫星的单位矢量看作不变,B用B(tk)来代替,将北斗三差载波观测方程变换为:
△y(tk+1,tk)=B(tk)·△b(tk+1,tk)-λ△a(tk+1,tk)+△ε(tk+1,tk)
其中,△b(tk+1,tk)=b(tk+1)-b(tk)为两个时刻基线矢量之差,b(tk)和b(tk+1)可利用惯导估算基线矢量来替代,其中 b ( t k ) = X I ( t k ) = C n e C ^ b n ( t k ) [ I - φ ( t k ) × ] X G , b ( t k + 1 ) = X I ( t k + 1 ) = C n e C ^ b n ( t k + 1 ) [ I - φ ( t k + 1 ) × ] X G .
(83)设计检验量为T=(B(tk)·△b(tk+1,tk)-△y(tk+1,tk))/λ,若检验量的值在0附近,说明未发生周跳;若检验量T的绝对值大于1/2,则发生周跳,用检验量T四舍五入取整来计算发生的周跳数目。
至此,一种短基线下基于惯导辅助的北斗卫星单频整周模糊度解算方法流程结束。
以上所述仅是本发明的优选实施方式,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。

Claims (6)

1.短基线下惯导辅助的北斗单频整周模糊度求解方法,其特征在于:包括如下步骤:
步骤一、信息初始化,采集北斗原始观测量并计算北斗双差观测量,为有效消除北斗双差观测量的大气延时误差,将北斗系统输出的北斗原始观测量按照北斗星座类型的轨道高度分组差分,从而得到北斗双差载波相位观测值以及北斗卫星到接收机的双差单位矢量,构造北斗双差载波观测方程;
步骤二、利用惯导输出姿态矩阵、平台误差角信息以及天线配置信息估算基线矢量地心地固坐标及相应的基线矢量方差矩阵;
步骤三、将步骤二得到的惯导估算基线矢量代入步骤一中的北斗双差载波观测方程,利用递推最小二乘法求解整周模糊度浮点解及其协方差矩阵;
步骤四、根据步骤三得到的整周模糊度浮点解及其协方差矩阵利用改进最小二乘模糊度去相关方法固定整周模糊度整数解,包括:
步骤五、利用惯导估算基线矢量集合北斗三差载波观测量一起构造检验量判断周跳是否发生,若发生周跳则利用检验量取整的方式估算周跳值并对整周模糊度进行修复。
2.根据权利要求1所述的短基线下惯导辅助的北斗单频整周模糊度求解方法,其特征在于:所述步骤一中,为有效消除北斗双差观测量的大气延时误差,将北斗系统输出的北斗原始观测量按照北斗星座类型的轨道高度进行分组差分:MEO卫星一组,卫星数量为n,取仰角最大的MEO卫星为基准;IGSO卫星和GEO卫星一组,卫星数量为m,取仰角最大的IGSO/GEO卫星作为基准;构造北斗双差载波观测方程如下:
其中,为第j颗MEO卫星到基准MEO卫星的双差载波观测相位,为第j颗IGSO卫星/GEO卫星到基准IGSO卫星/GEO卫星的双差载波观测相位,为MEO卫星到载体之间的单位矢量,为GEO卫星/IGSO卫星到载体之间的单位矢量,为第j颗MEO卫星到基准MEO卫星的双差整周模糊度,为第j颗IGSO卫星/GEO卫星到基准IGSO卫星/GEO卫星的双差整周模糊度,为第j颗MEO卫星到基准MEO卫星的双差观测噪声,为第j颗IGSO卫星/GEO卫星到基准IGSO卫星/GEO卫星的双差观测噪声,λ为北斗B1频率信号的载波波长,为基线矢量。
3.根据权利要求2所述的短基线下惯导辅助的北斗单频整周模糊度求解方法,其特征在于:所述步骤二中,利用惯导输出姿态矩阵、平台误差角信息以及天线配置信息估算基线矢量地心地固坐标及相应的基线矢量方差矩阵为:
X I = C n e C b n X G = C n e C ^ b n ( I - φ ) X G
cov [ X I ] = C n e C ^ b n X G × cov [ φφ T ] [ X G b ] T [ C ^ b n ] T [ C n e ] T
其中,XI为惯导估算基线矢量,XG为北斗天线构成的基线在机体坐标系内的向量;为机体坐标系到地理坐标系的理想姿态矩阵,为惯导实际输出的机体坐标系到地理坐标系中的姿态矩阵,为地理坐标系到地心地固坐标系的转换矩阵,φ为平台误差角向量,cov[φφT]为平台误差角方差阵,I为单位矩阵,cov[XI]为惯导估算基线矢量的协方差矩阵。
4.根据权利要求3所述的短基线下惯导辅助的北斗单频整周模糊度求解方法,其特征在于:所述步骤四中,根据步骤三得到的整周模糊度浮点解及其协方差矩阵利用改进最小二乘模糊度去相关法固定整周模糊度整数解,包括:
(41)将整周模糊度浮点解协方差矩阵中的正对角线元素先进行顺序排序,再对排序后的协方差矩阵进行LDLT分解,得到整周模糊度去相关变换矩阵;
(42)利用整周模糊度去相关变换矩阵使整周模糊度去相关,然后结合整周模糊度的搜索条件固定整周模糊度整数解。
5.根据权利要求4述的短基线下惯导辅助的北斗单频整周模糊度求解方法,其特征在于:所述步骤四中,整周模糊度去相关变换矩阵获取方法如下:
(411)确定排序矩阵P,首先将矩阵P设定为与矩阵维数相同的零矩阵,然后将整周模糊度协方差矩阵中的正对角线元素Qii按升序排列,若Qii在排序后位于矩阵对角线元素的第m位,则令矩阵P中的元素Pmi=1,否则为零,计算得到矩阵P中所有元素的值后,计算排序后的矩阵其中i=1、2、…,m=1、2、…;
(412)然后对排序后的矩阵QP进行LDLT整数分解,得到下三角矩阵L后代入到Q=[L]-1QP[LT]-1中进行计算;
(413)基于(411)和(412)两个步骤,不断地进行迭代,直到矩阵[L]-1为单位阵结束;最终可以得到整周模糊度去相关变换矩阵为:Z=[L1]-1P1[L2]-1P2…[Lk]-1Pk
6.根据权利要求5所述的短基线下惯导辅助的北斗单频整周模糊度求解方法,其特征在于:所述步骤五中,利用惯导估算基线矢量集合北斗三差载波观测量一起构造检验量判断周跳是否发生,若发生周跳则利用检验量取整的方式估算周跳值并对整周模糊度进行修复,其中构造的检验量为:
T=(B(tk)·Δb(tk+1,tk)-Δy(tk+1,tk))/λ
其中,Δy(tk+1,tk)=y(tk+1)-y(tk),y(tk)为tk时刻的北斗三差载波观测量;Δb(tk+1,tk)=b(tk+1)-b(tk),b(tk)和b(tk+1)使用惯导估算基线矢量代替,B(tk)为tk时刻对应分组的设计矩阵,
若检验量T的绝对值大于1/2,则发生周跳,用检验量T四舍五入取整来计算发生周跳的数目。
CN201410568818.3A 2014-10-22 2014-10-22 短基线下惯导辅助的北斗单频整周模糊度求解方法 Expired - Fee Related CN104375157B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410568818.3A CN104375157B (zh) 2014-10-22 2014-10-22 短基线下惯导辅助的北斗单频整周模糊度求解方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410568818.3A CN104375157B (zh) 2014-10-22 2014-10-22 短基线下惯导辅助的北斗单频整周模糊度求解方法

Publications (2)

Publication Number Publication Date
CN104375157A CN104375157A (zh) 2015-02-25
CN104375157B true CN104375157B (zh) 2017-01-25

Family

ID=52554186

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410568818.3A Expired - Fee Related CN104375157B (zh) 2014-10-22 2014-10-22 短基线下惯导辅助的北斗单频整周模糊度求解方法

Country Status (1)

Country Link
CN (1) CN104375157B (zh)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105549057B (zh) * 2015-12-07 2018-08-17 韩厚增 一种惯性辅助的gps/bds融合大比例尺快速宗地测量装置与方法
US10261194B2 (en) * 2016-01-06 2019-04-16 Honeywell International Inc. Systems and methods for vehicle attitude determination
CN107193028B (zh) * 2017-03-29 2020-05-22 中国航空无线电电子研究所 基于GNSS的Kalman相对定位方法
CN107505642B (zh) * 2017-10-23 2020-04-28 中国矿业大学 一种ins辅助的实时bds单频周跳探测方法
CN108196281B (zh) * 2017-11-22 2021-10-29 同济大学 一种基于位置域曲线约束的单频动态周跳探测与修复方法
CN108802782B (zh) * 2018-05-18 2021-02-09 东南大学 一种惯导辅助的北斗三频载波相位整周模糊度求解方法
CN109840067B (zh) * 2019-01-14 2021-04-20 中国人民解放军国防科技大学 一种基于数学近似的浮点程序精度缺陷修复方法
CN110133585A (zh) * 2019-06-27 2019-08-16 江苏芯盛智能科技有限公司 双频双动态定位方法、装置、定位设备及运载工具
CN110927756B (zh) * 2019-11-25 2022-08-23 上海双微导航技术有限公司 卫星轨道机动探测方法、装置、设备和存储介质
US11821998B2 (en) 2020-05-21 2023-11-21 Honeywell International Inc. Three-dimensional attitude determination system with multi-faceted integrity solution
CN111999750B (zh) * 2020-10-29 2021-01-08 中国人民解放军国防科技大学 针对杆臂不准的实时单站周跳探测改进方法
CN113238266A (zh) * 2021-05-10 2021-08-10 株洲长远智造股份有限公司 基于北斗定位的铺轨机智能导向系统及方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6052082A (en) * 1998-05-14 2000-04-18 Wisconsin Alumni Research Foundation Method for determining a value for the phase integer ambiguity and a computerized device and system using such a method
US6127968A (en) * 1998-01-28 2000-10-03 Trimble Navigation Limited On-the-fly RTK positioning system with single frequency receiver
CN1924606A (zh) * 2006-09-04 2007-03-07 南京航空航天大学 基于北斗双星系统的快速测量载体姿态的方法
CN102590843A (zh) * 2012-01-13 2012-07-18 南京航空航天大学 一种短基线下基于分级小型搜索空间添加的tcar改进方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6127968A (en) * 1998-01-28 2000-10-03 Trimble Navigation Limited On-the-fly RTK positioning system with single frequency receiver
US6052082A (en) * 1998-05-14 2000-04-18 Wisconsin Alumni Research Foundation Method for determining a value for the phase integer ambiguity and a computerized device and system using such a method
CN1924606A (zh) * 2006-09-04 2007-03-07 南京航空航天大学 基于北斗双星系统的快速测量载体姿态的方法
CN102590843A (zh) * 2012-01-13 2012-07-18 南京航空航天大学 一种短基线下基于分级小型搜索空间添加的tcar改进方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
M-Epoch Ambiguity Resolution Technique for Single Frequency Receivers with INS Aid;Tatsuya Iwase etal.;《Position Location and Navigation Symposium(PLANS),2012 IEEE/ION》;20120426;第706-710页 *
一种GPS整周模糊度的解算方法;林雪原 等;《海军航空工程学院学报》;20080131;第23卷(第1期);第5-12页 *
惯性辅助超短基线GPS航姿解算;段志勇,袁信;《中国惯性技术学报》;19991231;第7卷(第4期);第45-48页 *

Also Published As

Publication number Publication date
CN104375157A (zh) 2015-02-25

Similar Documents

Publication Publication Date Title
CN104375157B (zh) 短基线下惯导辅助的北斗单频整周模糊度求解方法
CN101403790B (zh) 单频gps接收机的精密单点定位方法
CN104597471B (zh) 面向时钟同步多天线gnss接收机的定向测姿方法
CN105372691B (zh) 一种模糊度固定的长基线卫星编队gnss相对定位方法
CN104714244B (zh) 一种基于抗差自适应Kalman滤波的多系统动态PPP解算方法
CN102288978B (zh) 一种cors基站周跳探测与修复方法
CN105223598B (zh) 一种gnss载波相位整周模糊度单历元解算方法
CN110058236A (zh) 一种面向三维地表形变估计的InSAR和GNSS定权方法
CN103616036B (zh) 一种基于合作目标的机载传感器系统误差估计与补偿方法
CN101833080A (zh) 一种利用gps系统附加约束条件的载体姿态测量方法
CN104865587A (zh) 基于geo星座粗定位的北斗接收机快速定位方法
CN104614741A (zh) 一种不受glonass码频间偏差影响的实时精密卫星钟差估计方法
CN101893712B (zh) 用于地球静止卫星精密定轨的选权拟合方法
CN104459722B (zh) 一种基于多余观测分量的整周模糊度可靠性检验方法
Dai et al. Innovative algorithms to improve long range RTK reliability and availability
CN105044738A (zh) 一种接收机自主完好性监视的预测方法及预测系统
CN105388496B (zh) 基于gps的交通应用脆弱性检测系统及其方法
CN104567802B (zh) 集成船载重力和gnss的测线式陆海高程传递方法
CN102590843B (zh) 一种短基线下基于分级小型搜索空间添加的tcar改进方法
Bramanto et al. Long-range single baseline RTK GNSS positioning for land cadastral survey mapping
Zhao et al. A new terrain matching method for estimating laser pointing and ranging systematic biases for spaceborne photon-counting laser altimeters
Mirzaee et al. Non-linear phase linking using joined distributed and persistent scatterers
CN109613582A (zh) 一种车载实时单频米级伪距定位方法
CN104991265A (zh) 一种北斗卫星导航系统用户统一性定位方法
CN115616643B (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
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20150225

Assignee: JIANGSU BDSTAR NAVIGATION AUTOMOTIVE ELECTRONICS CO.,LTD.

Assignor: Nanjing University of Aeronautics and Astronautics

Contract record no.: 2018320000067

Denomination of invention: Inertial navigation assisted Big Dipper single-frequency whole-cycle ambiguity calculation method under short baseline condition

Granted publication date: 20170125

License type: Exclusive License

Record date: 20180320

EE01 Entry into force of recordation of patent licensing contract
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20170125

Termination date: 20211022

CF01 Termination of patent right due to non-payment of annual fee