CN109085629B - Gnss基线向量解算定位方法、装置和导航定位设备 - Google Patents

Gnss基线向量解算定位方法、装置和导航定位设备 Download PDF

Info

Publication number
CN109085629B
CN109085629B CN201810995758.1A CN201810995758A CN109085629B CN 109085629 B CN109085629 B CN 109085629B CN 201810995758 A CN201810995758 A CN 201810995758A CN 109085629 B CN109085629 B CN 109085629B
Authority
CN
China
Prior art keywords
vector
observation model
error
error observation
observation
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.)
Active
Application number
CN201810995758.1A
Other languages
English (en)
Other versions
CN109085629A (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.)
Hi Target Surveying Instrument Co ltd
Original Assignee
Hi Target Surveying Instrument Co ltd
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 Hi Target Surveying Instrument Co ltd filed Critical Hi Target Surveying Instrument Co ltd
Priority to CN201810995758.1A priority Critical patent/CN109085629B/zh
Publication of CN109085629A publication Critical patent/CN109085629A/zh
Application granted granted Critical
Publication of CN109085629B publication Critical patent/CN109085629B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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/43Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
    • G01S19/44Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

本发明涉及一种GNSS基线向量解算定位方法、装置、导航定位设备和计算机可读存储介质,其中方法包括:根据获取的观测数据,构建第一误差观测模型;根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入虚拟观测模型,得到第二误差观测模型;根据第一误差观测模型和第二误差观测模型,得到联合误差观测模型;根据联合误差观测模型,求得基线的浮点解及其协方差矩阵进行定位。上述方案,可解决传统卡尔曼滤波基线解算在观测卫星数增多时,增益矩阵运算量显著增多,导致基线解算定位效率下降的问题,有效提升GNSS基线向量解算定位效率。

Description

GNSS基线向量解算定位方法、装置和导航定位设备
技术领域
本发明涉及卫星导航定位技术领域,特别是涉及一种GNSS基线向量解算定位方法、GNSS基线向量解算定位装置、导航定位设备和计算机可读存储介质。
背景技术
随着俄罗斯格洛纳斯全球卫星导航系统(Global Navigation SatelliteSystem,GLONASS)的全面恢复、中国的北斗全球卫星导航系统(BeiDou NavigationSatellite System,BDS)以及欧洲的伽利略卫星导航系统(Galileo satellitenavigation system,Galileo)的持续建设。全球导航卫星系统(Global NavigationSatellite System,GNSS)卫星的可用数快速增加,多GNSS系统组合定位成为当前以及未来GNSS定位的首选,其精度和可靠性较之单系统而言都得到了提高。虽然GNSS观测卫星数增加提高了定位精度和可靠性,但是也造成了GNSS定位解算效率的下降,降低了GNSS定位的实时性,限制了高频率卫星定位信息的输出。
当前,GNSS动态定位中多采用卡尔曼滤波进行基线向量解算定位,其解算效率与卫星观测方程的个数成负相关,即观测卫星数越多,则卫星观测方程越多,解算效率越低。对于GNSS多模组合定位观测卫星数较多的情况,例如GPS/BDS双系统可以达到十几颗卫星,GPS/BDS/GLONASS三系统可以观测到二十多颗卫星。卡尔曼滤波在GNSS多模组合定位中,观测卫星数增多会导致现有的卡尔曼滤波法的运算量显著增多,基线解算定位效率显著下降。
发明内容
基于此,有必要针对上述技术问题,提供一种能够提升基线向量解算定位效率的GNSS基线向量解算定位方法、GNSS基线向量解算定位装置、导航定位设备和计算机可读存储介质。
一种GNSS基线向量解算定位方法,所述方法包括:
根据获取的观测数据,构建第一误差观测模型;
根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型;
根据第一误差观测模型和第二误差观测模型,得到联合误差观测模型;
根据所述联合误差观测模型,求得基线向量的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。
上述GNSS基线向量浮点解获取方法,根据获取的观测数据,构建第一误差观测方程和第二误差观测方程得到的联合误差观测方程,求得基线向量的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。本发明的上述基线向量解算定位方法不涉及传统的卡尔曼滤波增益矩阵的计算,解决传统卡尔曼滤波基线解算在观测卫星数增多时,增益矩阵运算量显著增多,导致基线解算定位效率显著下降的问题,有效提升了GNSS基线向量浮点解的获取效率,从而提升了定位效率。
在一个实施例中,所述根据获取的观测数据,构建第一误差观测模型的步骤包括:根据获取的观测数据,构建第二历元时刻的基本误差观测模型;以状态向量在第二历元时刻的状态预测向量作为第二历元时刻所述状态向量的近似值,对所述基本误差观测模型进行线性化处理,得到第一误差观测模型;其中,所述第一误差观测模型包括观测向量的残差向量、第一误差观测模型的设计矩阵和第一误差观测模型的权阵。
在一个实施例中,所述根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,构建第二误差观测模型包括:根据状态向量的先验信息,构建虚拟观测模型,其中,所述虚拟观测模型包括状态向量在第二历元时刻的虚拟观测值向量和虚拟观测模型的权阵;以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型,其中,所述第二误差观测模型包括状态向量的残差向量和第二误差观测模型的权阵。
在一个实施例中,所述根据第一误差观测模型和第二误差观测模型,得到联合误差观测模型包括:联合第一误差观测模型和第二误差观测模型得到基本联合误差观测模型;根据最小二乘平差原理,对所述基本联合误差观测模型进行简化处理,得到联合误差观测模型。
上述实施例的技术方案,采用最小二乘法进行GNSS基线向量的解算获取,对基线向量解算进行运算简化,有效提升基线向量浮点解解算的效率。
在一个实施例中,所述第一误差观测模型的权阵为分块对角矩阵;所述根据所述联合误差观测模型,求得基线的浮点解及其协方差矩阵的步骤包括:采用稀疏矩阵分块方法对所述联合误差观测模型进行简化求解,求得第二历元时刻状态向量相对于状态向量初值的浮点改正数;并根据所述浮点改正数以及所述联合误差观测模型,确定待解算的所述状态向量在第二历元时刻的浮点解及其协方差矩阵。
上述实施例的技术方案,第一误差观测模型的观测向量的噪声协方差矩阵为分块对角阵时,观测方程的权阵也是分块对角阵,进而采用阵稀疏矩阵分块方法对所述联合误差观测模型进行简化求解,以提升基线解算的定位效率。
在一个实施例中,所述第一误差观测模型表示如下:
Figure GDA0002639468260000031
上式中,k为第一历元时刻,k+1为第二历元时刻,Vobs为观测向量的残差向量,Hk+1为第二历元时第一误差观测模型的设计矩阵,Zk+1为第二历元时刻的观测向量,Xk+1|k为第二历元时刻的状态预测向量,f(Xk+1|k)为第二历元时刻基于状态预测向量计算得到的观测值的计算值向量,Pk+1为第一误差观测模型的权阵,Rk+1为第二历元时观测向量的噪声协方差矩阵;
所述构建的虚拟观测模型表示如下:
Figure GDA0002639468260000032
上式中,X为状态向量,εx为误差向量,Px为虚拟观测模型的权阵,Qk+1|k为第二历元时状态预测向量的噪声协方差矩阵;
所述第二误差观测模型表示如下:
Figure GDA0002639468260000033
上式中,Vx为状态向量的残差向量,I为单位阵,dx为第二历元时状态向量X以预测向量Xk+1|k作为初值的改正数向量;
所述基本联合误差观测模型表示如下:
Figure GDA0002639468260000041
根据最小二乘平差原理,对所述基本联合误差观测模型进行简化处理,得到的联合误差观测模型表示如下:
Figure GDA0002639468260000042
在一个实施例中,所述第二历元时观测向量的噪声协方差矩阵表示如下:
Figure GDA0002639468260000043
上式中,Q为观测向量的先验方差阵,上标P表示伪距,上标L表示载波,下标gps、glo、bds和gal依次表示GPS卫星导航系统、Glonass卫星导航系统、BDS卫星导航系统和Galileo卫星导航系统;
所述第二历元时第一误差观测模型的设计矩阵表示如下:
Figure GDA0002639468260000044
上式中,A为状态向量非模糊度坐标参数部分对应的设计矩阵,B为状态向量模糊度参数部分对应的设计矩阵;
所述采用稀疏矩阵分块方法对所述联合误差观测模型进行简化求解,求得第二历元时刻状态向量相对于状态向量初值的浮点改正数;并根据所述浮点改正数以及所述联合误差观测模型,确定待解算的所述状态向量在第二历元时刻的浮点解及其协方差矩阵包括步骤:
利用对角矩阵Pk+1和Hk+1
Figure GDA0002639468260000051
进行简化计算表示如下:
Figure GDA0002639468260000052
根据所述
Figure GDA0002639468260000053
Figure GDA0002639468260000054
进行简化计算表示如下:
Figure GDA0002639468260000055
其中,
Figure GDA0002639468260000056
根据所述
Figure GDA0002639468260000057
Figure GDA0002639468260000058
进行简化计算表示如下:
Figure GDA0002639468260000059
其中,
Figure GDA00026394682600000510
上述步骤技术方案,运用稀疏矩阵分块计算对浮点解解算进行对角阵简化计算,有效提升了GNSS基线向量浮点解解算的效率。
根据简化计算得到的所述
Figure GDA00026394682600000511
Figure GDA00026394682600000512
确定待解算的所述状态向量在第二历元时刻的浮点解及其协方差矩阵;
其中,所述浮点解表示如下:
Xk+1=Xk+1|k+dx
上式中,浮点改正数dx表示如下:
Figure GDA0002639468260000061
所述协方差矩阵表示如下:
Figure GDA0002639468260000062
本发明的上述技术方案,采用最小二乘法进行GNSS基线向量的解算获取,解决传统的卡尔曼滤波法在GNSS基线解算中,随着卫星数目增多运算量显著增多,导致运算效率降低的问题,提升运算效率。
一种GNSS基线向量解算定位装置,所述装置包括:
第一模型构建模块,用于根据获取的观测数据,构建第一误差观测模型;
第二模型构建模块,用于根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型;
联合模型构建模块,用于根据第一误差观测模型和第二误差观测模型,得到联合误差观测模型;
基线向量解算定位模块,用于根据所述联合误差观测模型,求得基线的浮点解及其协方差矩阵,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。
上述GNSS基线向量解算定位装置,根据获取的观测数据,构建第一误差观测方程和第二误差观测方程得到的联合误差观测方程,求解得到基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。本发明的上述基线向量解算定位方法不涉及传统的卡尔曼滤波增益矩阵的计算,解决传统卡尔曼滤波基线解算在观测卫星数增多时,增益矩阵运算量显著增多,导致基线解算定位效率显著下降的问题,有效提升了GNSS基线向量浮点解的获取效率,从而提升了定位效率。
一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现以下步骤:
根据获取的观测数据,构建第一误差观测模型;
根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型;
根据第一误差观测模型和第二误差观测模型,得到联合误差观测模型;
根据所述联合误差观测模型,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。
上述计算机设备,其处理器执行程序时,通过实现如上步骤,从而可以根据获取的观测数据,构建第一误差观测方程和第二误差观测方程得到的联合误差观测方程,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。本发明的上述基线向量解算定位方法不涉及传统的卡尔曼滤波增益矩阵的计算,解决传统卡尔曼滤波基线解算在观测卫星数增多时,增益矩阵运算量显著增多,导致基线解算定位效率显著下降的问题,有效提升了GNSS基线向量浮点解的获取效率,从而提升了定位效率。
一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现以下步骤:
根据获取的观测数据,构建第一误差观测模型;
根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型;
根据第一误差观测模型和第二误差观测模型,得到联合误差观测模型;
根据所述联合误差观测模型,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。
上述计算机存储介质,其存储的计算机程序,通过实现如上步骤,从而可以根据获取的观测数据,构建第一误差观测方程和第二误差观测方程得到的联合误差观测方程,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。本发明的上述基线向量解算定位方法不涉及传统的卡尔曼滤波增益矩阵的计算,解决传统卡尔曼滤波基线解算在观测卫星数增多时,增益矩阵运算量显著增多,导致基线解算定位效率显著下降的问题,有效提升了GNSS基线向量的浮点解解算效率。
一种导航定位设备,其特征在于,所述导航定位设备在进行导航定位时执行如上任一实施例所述的GNSS基线向量解算定位方法的步骤。
上述导航定位设备,在进行导航定位时,通过实现如上任一实施例所述的GNSS基线向量解算定位方法的步骤,从而可以根据获取的观测数据,构建第一误差观测方程和第二误差观测方程得到的联合误差观测方程,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。本发明的上述基线向量解算定位方法不涉及传统的卡尔曼滤波增益矩阵的计算,解决传统卡尔曼滤波基线解算在观测卫星数增多时,增益矩阵运算量显著增多,导致基线解算定位效率显著下降的问题,有效提升了GNSS基线向量浮点解的获取效率,从而提升了定位效率。
附图说明
图1为一个实施例中GNSS基线向量解算定位方法的应用环境图;
图2为一个实施例中GNSS基线向量解算定位方法的流程示意图;
图3为另一个实施例中GNSS基线向量解算定位方法的流程示意图;
图4为一个实施例中GNSS基线向量解算定位装置的结构框图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
本发明提供的GNSS基线向量解算定位方法,可以应用于如图1所示的应用环境中。包括流动站101、基准站102和多个卫星103,其中,流动站101与基准站102通过数据链进行通信,流动站101和基准站102分别接收卫星103的信号。其中,卫星可以包括例如GPS卫星、Glonass卫星、BDS卫星和Galileo卫星中的一种或多种组合,基准站102是对卫星导航信号进行长期连续观测或者临时架设的地面固定观测站,流动站101可以是例如手机、接收机或其它专用导航定位设备等。基准站102将其接收的卫星观测值和基准站坐标信息等差分信息一起传送给流动站101,流动站101接收基准站102的数据,并同步采集观测数据进行基线向量解算处理,获取解算得到的定位结果。
在一个实施例中,如图2所示,提供了一种GNSS基线向量解算定位方法,以该方法应用于图1中的流动站101为例进行说明,包括以下步骤:
S210,根据获取的观测数据,构建第一误差观测模型。
其中,所述观测数据为流动站接收机采集的多个卫星的载波相位观测值、伪距观测值以及基准站同步接收并播发多个卫星的载波观测值、伪距观测值;第一误差观测模型中可以包括例如第一误差观测方程。
在此步骤中,流动站根据采集获取的多个卫星的观测数据,构建第一误差观测模型。
S220,根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型。
其中,当第二历元表示基线解算的首历元时,状态预测向量表示状态初始向量,其值可以通过观测值计算得到,如位置可以通过伪距单点定位得到,速度可以由多普勒测速得到,模糊度向量初值可以由伪距与载波观测值作差得到。当第二历元表示非首历元时,状态预测向量为根据前一历元时刻状态向量结合状态参数的特性预估的下一历元时刻的预测向量,例如,坐标参数可以通过动态模型进行时间传递,而模糊度参数为非时变参数,可以由上一历元的状态传递至其下一历元作为状态预估值。虚拟观测模型可以包括虚拟观测方程,第二误差观测模型可以包括例如第二误差观测方程;
在此步骤中,流动站根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型。
S230,根据第一误差观测模型和第二误差观测模型,得到联合误差观测模型。
其中,联合误差观测模型可以包括联合误差观测方程。
在此步骤中,流动站将第一误差观测模型和第二误差观测模型联合起来,得到联合误差观测模型。
S240,根据所述联合误差观测模型,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。
在此步骤中,流动站根据前述步骤得到的联合误差观测模型,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵对流动站进行定位,获取导航定位结果。具体地,可以根据基线向量浮点解及其协方差矩阵继续固定载波相位模糊度进而计算高精度的基线固定解以进行导航定位,或者也可以直接输出基线向量浮点解及其协方差矩阵用于导航定位。流动站可根据该步骤获取的基线向量解算结果对流动站进行定位。
上述GNSS基线向量解算定位方法,根据获取的观测数据,构建第一误差观测方程和第二误差观测方程得到的联合误差观测方程,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。本发明的上述基线向量解算定位方法不涉及传统的卡尔曼滤波增益矩阵的计算,解决传统卡尔曼滤波基线解算在观测卫星数增多时,增益矩阵运算量显著增多,导致基线解算定位效率显著下降的问题,有效提升了GNSS基线向量浮点解的获取效率,从而提升了定位效率。
在一个实施例中,如图3所示,提供了一种GNSS基线向量解算定位方法,以该方法应用于图1中的流动站为例进行说明,包括以下步骤:
S310,根据获取的观测数据,构建第一误差观测模型。
在一个实施例中,步骤S310中所述根据获取的观测数据,构建第一误差观测模型的步骤包括:
S311,根据获取的观测数据,构建第二历元时刻的基本误差观测模型;
其中,基本误差观测模型可以包括基本误差观测方程。
在一个实施例中,所述基本误差观测模型可以表示如下:
Z=f(X)+ε (1)
上式中,Z为第二历元时刻的观测向量,f(X)为第二历元时基于状态预测向量计算得到的观测值的计算值向量,ε为观测误差向量。
S312,以状态向量在第二历元时刻的状态预测向量作为第二历元时刻待估算的状态向量Xk+1的近似值,对所述基本误差观测模型进行线性化处理,得到第一误差观测模型;其中,所述第一误差观测模型包括观测向量的残差向量、第一误差观测模型的设计矩阵和第一误差观测模型的权阵。
其中,状态预测向量为状态向量在第二历元时刻的预测向量。
在一个实施例中,对上述式(1)进行线性化,得到所述第一误差观测模型表示如下:
Figure GDA0002639468260000111
上式中,k为第一历元时刻,k+1为第二历元时刻,Vobs为观测向量的残差向量,Hk+1为第二历元时第一误差观测模型的设计矩阵,Zk+1为第二历元时的观测向量,Xk+1|k为第二历元时刻的状态预测向量,f(Xk+1|k)为第二历元时基于状态预测向量计算得到的观测值的计算值向量,Pk+1为第一误差观测模型的权阵,Rk+1为第二历元时观测向量的噪声协方差矩阵。
其中,第二历元可以为任意历元时刻,例如可以是接收机当前采集数据的历元时刻。当第二历元不表示基线向量解算的首历元时,第一历元是第二历元的上一历元。
其中,第二历元时刻的状态预测向量表示如下:
Xk+1|k=Fk|k+1Xk (3)
上式中,Xk+1|k为第二历元时刻的状态预测向量,Fk|k+1为第一历元时刻到第二历元时刻状态向量时间传递矩阵。
其中,所述第二历元时观测向量的噪声协方差矩阵表示如下:
Figure GDA0002639468260000112
上式中,Q为观测向量的先验方差阵,上标P表示伪距,上标L表示载波,下标gps、glo、bds和gal依次表示GPS卫星导航系统、Glonass卫星导航系统、BDS卫星导航系统和Galileo卫星导航系统;
由于上述式(4)为分块对角矩阵,根据式(4)算得对应的所述第一误差观测模型的权阵表示如下:
Figure GDA0002639468260000121
所述第二历元时第一误差观测模型的设计矩阵表示如下:
Figure GDA0002639468260000122
GNSS基线向量的状态向量参数可以简单划分为非模糊度参数部分和模糊度参数部分两部分;上式中,A为状态向量非模糊度坐标参数部分对应的设计矩阵,B为状态向量模糊度参数部分对应的设计矩阵,下标gps、glo、bds和gal依次表示GPS卫星导航系统、Glonass卫星导航系统、BDS卫星导航系统和Galileo卫星导航系统。
S320,根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型。
在一个实施例中,步骤S320所述根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型包括:
S321,根据状态向量的先验信息,构建虚拟观测模型,其中,所述虚拟观测模型包括状态向量在第二历元时刻的虚拟观测值向量和虚拟观测模型的权阵;
在一个实施例中,S321所述构建的虚拟观测模型表示如下:
Figure GDA0002639468260000131
上式中,X为第二历元时刻待估状态向量,Xk+1|k为第二历元状态向量的预测向量,在虚拟观测模型式(7)中作为虚拟观测值向量,εx为误差向量,Px为虚拟观测模型的权阵,Qk+1|k为第二历元时状态预测向量的噪声协方差矩阵;
其中,第二历元时状态预测向量的噪声协方差矩阵表示如下:
Figure GDA0002639468260000132
S322,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型,其中,所述第二误差观测模型包括状态向量的残差向量和第二误差观测模型的权阵。
在一个实施例中,将第二历元时刻状态预测量Xk+1|k作为第二历元时刻待估状态向量X的初值,代入式(7),得到所述第二误差观测模型表示如下:
Figure GDA0002639468260000133
上式中,Vx为状态向量的残差向量,I为单位阵,dx为第二历元时待估状态向量X以预测向量Xk+1|k作为初值的改正数向量;
S330,根据第一误差观测模型和第二误差观测模型,得到联合误差观测模型。
在一个实施例中,步骤S330中所述根据第一误差观测模型和第二误差观测模型,得到联合误差观测模型包括:
S331,联合第一误差观测模型和第二误差观测模型得到基本联合误差观测模型;
其中,基本联合误差观测模型可以包括基本联合误差观测方程。
在一个实施例中,联合上述式(2)的第一误差观测模型的和式(9)的第二误差观测模型,得到的所述基本联合误差观测模型表示如下:
Figure GDA0002639468260000141
S332,根据最小二乘平差原理,对所述基本联合误差观测模型进行简化处理,得到联合误差观测模型。
在一个实施例中,根据最小二乘平差原理,对上述式(10)的基本联合误差观测模型进行简化处理,得到的联合误差观测模型表示如下:
Figure GDA0002639468260000142
对上述式(11)进行整理得到式(12):
Figure GDA0002639468260000143
上述实施例的技术方案,采用最小二乘法进行GNSS基线向量的解算获取,对基线向量解算进行运算简化,有效提升基线向量解算的效率。
S340,根据所述联合误差观测模型,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。
在一个实施例中,步骤S310中所述第一误差观测模型的权阵为分块对角矩阵;
步骤S340包括:
S341,采用稀疏矩阵分块方法对所述联合误差观测模型进行简化求解,求得第二历元时刻状态向量相对于状态向量初值的浮点改正数;
S342,根据所述浮点改正数以及所述联合误差观测模型,确定待解算的所述状态向量在第二历元时刻的浮点解及其协方差矩阵;
S343,根据所述基线的浮点解及其协方差矩阵进行定位。
上述实施例的技术方案,第一误差观测模型的观测向量的噪声协方差矩阵为分块对角阵时,观测方程的权阵也是分块对角阵,进而采用阵稀疏矩阵分块方法对所述联合误差观测模型进行简化求解,以提升基线解算的定位效率。
进一步地,在一个实施例中,上述步骤S341和S342中所述采用稀疏矩阵分块方法对所述联合误差观测模型进行简化求解,求得第二历元时刻状态向量相对于状态向量初值的浮点改正数;并根据所述浮点改正数以及所述联合误差观测模型,确定待解算的所述状态向量在第二历元时刻的浮点解及其协方差矩阵包括步骤:
由上式(4)和式(5)可知,Rk+1为分块对角阵时,观测方程的权阵Pk+1也是分块对角阵,进而可以简化对
Figure GDA0002639468260000151
Figure GDA0002639468260000152
的求解,,
Figure GDA0002639468260000153
只需计算非0矩阵块即可,降低了矩阵相乘的维数,能够有效减少计算量,提升基线解算效率。
利用对角矩阵Pk+1和Hk+1对HT k+1Pk+1进行简化计算表示如下:
Figure GDA0002639468260000154
根据所述
Figure GDA0002639468260000155
Figure GDA0002639468260000156
进行简化表示如下:
Figure GDA0002639468260000157
其中,
Figure GDA0002639468260000158
根据所述
Figure GDA0002639468260000159
Figure GDA00026394682600001510
进行简化计算表示如下:
Figure GDA00026394682600001511
其中,
Figure GDA0002639468260000161
现有的卡尔曼滤波算法的Qk+1|k阵为非对角阵,也不是稀疏矩阵,其增益矩阵Kk+1只能直接进行矩阵相乘计算,计算效率较低。本发明上述实施例的技术方案,根据式(14)和式(15)对
Figure GDA0002639468260000162
Figure GDA0002639468260000163
进行稀疏矩阵分块计算,较之直接矩阵相乘计算,上述方案可以大大减少矩阵相乘的计算量,提高基线解算的效率。
根据简化计算得到的所述
Figure GDA0002639468260000164
Figure GDA0002639468260000165
确定待解算的所述状态向量在第二历元时刻的浮点解及其协方差矩阵;
其中,所述浮点解表示如下:
Xk+1=Xk+1|k+dx (16)
上式中,浮点改正数dx表示如下:
Figure GDA0002639468260000166
所述协方差矩阵表示如下:
Figure GDA0002639468260000167
现有的卡尔曼滤波法在求解状态向量浮点解时,其主要计算量在于计算增益矩阵时的求逆计算,其求逆矩阵的维数等于观测方程的个数,以单频为例,每增加一颗卫星,卡尔曼滤波法就会增加一个伪距和一个载波观测方程,即增加两个观测方程,卡尔曼滤波增益矩阵计算涉及求逆矩阵的维数很大,卫星数增多会导致卡尔曼滤波法的运算量显著增多,基线解算效率低。而采用本发明的最小二乘法即式(16)求解状态向量浮点解,其主要计算量在于
Figure GDA0002639468260000168
的计算,其求逆维数为参数的个数,其维数随观测卫星数的增长较之卡尔曼滤波慢,以单频为例,每增加一颗观测卫星,只增加一个模糊度参数,最小二乘法中
Figure GDA0002639468260000169
维数增加1,而卡尔曼滤波中增益矩阵的维数会增加2。
综上所述,本发明的上述技术方案,采用最小二乘法进行GNSS基线向量的解算获取,解决传统的卡尔曼滤波法在GNSS基线解算中,随着卫星数目增多运算量显著增多,导致运算效率降低的问题,提升运算效率;进一步地,运用稀疏矩阵分块计算对浮点解解算进行对角阵简化计算,有效提升了GNSS基线向量解算的效率,提升卫星导航定位的实时性。
应该理解的是,虽然图2-3的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图2-3中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些子步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
在一个实施例中,如图4所示,提供了一种GNSS基线向量解算定位装置,包括:
第一模型构建模块410,用于根据获取的观测数据,构建第一误差观测模型;
第二模型构建模块420,用于根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型;
联合模型构建模块430,用于根据第一误差观测模型和第二误差观测模型,得到联合误差观测模型;
基线向量解算定位模块440,用于根据所述联合误差观测模型,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。
上述GNSS基线向量解算定位装置,根据获取的观测数据,构建第一误差观测方程和第二误差观测方程得到的联合误差观测方程,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。本发明的上述基线向量解算定位方法不涉及传统的卡尔曼滤波增益矩阵的计算,解决传统卡尔曼滤波基线解算在观测卫星数增多时,增益矩阵运算量显著增多,导致基线解算定位效率显著下降的问题,有效提升了GNSS基线向量浮点解的获取效率,从而提升了定位效率。
在一个实施例中,第一模型构建模块410包括:
基本误差观测模型构建模块,用于根据获取的观测数据,构建第二历元时刻的基本误差观测模型;
第一误差观测模型构建模块,用于以状态向量在第二历元时刻的状态预测向量作为第二历元时刻所述状态向量的近似值,对所述基本误差观测模型进行线性化处理,得到第一误差观测模型;其中,所述第一误差观测模型包括观测向量的残差向量、第一误差观测模型的设计矩阵和第一误差观测模型的权阵。
在一个实施例中,基本误差观测模型可以表示如下:
Z=f(X)+ε
上式中,Z为第一历元时刻的观测向量,f(X)为第一历元时基于状态预测向量计算得到的观测值的计算值向量,ε为观测误差向量。
在一个实施例中,所述第一误差观测模型表示如下:
Figure GDA0002639468260000181
上式中,k为第一历元时刻,k+1为第二历元时刻,Vobs为观测向量的残差向量,Hk+1为第二历元时第一误差观测模型的设计矩阵,Zk+1为第二历元时的观测向量,Xk+1|k为第二历元时刻的状态预测向量,f(Xk+1|k)为第二历元时基于状态预测向量计算得到的观测值的计算值向量,Pk+1为第一误差观测模型的权阵,Rk+1为第二历元时观测向量的噪声协方差矩阵。
其中,所述第二历元时观测向量的噪声协方差矩阵表示如下:
Figure GDA0002639468260000182
上式中,Q为观测向量的先验方差阵,上标P表示伪距,上标L表示载波,下标gps、glo、bds和gal依次表示GPS卫星导航系统、Glonass卫星导航系统、BDS卫星导航系统和Galileo卫星导航系统;
所述第一误差观测模型的权阵表示如下:
Figure GDA0002639468260000191
所述第二历元时第一误差观测模型的设计矩阵表示如下:
Figure GDA0002639468260000192
上式中,A为状态向量非模糊度坐标参数部分对应的设计矩阵,B为状态向量模糊度参数部分对应的设计矩阵,下标gps、glo、bds和gal依次表示GPS卫星导航系统、Glonass卫星导航系统、BDS卫星导航系统和Galileo卫星导航系统。
在一个实施例中,第二模型构建模块420包括:
虚拟观测模型构建模块,用于根据状态向量的先验信息,构建虚拟观测模型,其中,所述虚拟观测模型包括状态向量在第二历元时刻的虚拟观测值向量和虚拟观测模型的权阵;
第二误差观测模型构建模块,用于以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型,其中,所述第二误差观测模型包括状态向量的残差向量和第二误差观测模型的权阵。
在一个实施例中,所述构建的虚拟观测模型表示如下:
Figure GDA0002639468260000193
上式中,X为状态向量,Xk+1|k为虚拟观测值向量,εx为误差向量,Px为虚拟观测模型的权阵,Qk+1|k为第二历元时状态预测向量的噪声协方差矩阵。
在一个实施例中,所述第二误差观测模型表示如下:
Figure GDA0002639468260000201
上式中,Vx为状态向量的残差向量,I为单位阵,dx为第二历元时待估状态向量X以预测向量Xk+1|k作为初值的改正数向量;
在一个实施例中,联合模型构建模块430包括:
基本联合误差观测模型构建模块,联合第一误差观测模型和第二误差观测模型得到基本联合误差观测模型;
联合误差观测模型构建模块,根据最小二乘平差原理,对所述基本联合误差观测模型进行简化处理,得到联合误差观测模型。
在一个实施例中,所述基本联合误差观测模型表示如下:
Figure GDA0002639468260000202
在一个实施例中,联合误差观测模型表示如下:
Figure GDA0002639468260000203
在一个实施例中,所述第一误差观测模型的权阵为分块对角矩阵;
基线向量解算定位模块440包括:
浮点改正数计算模块,用于采用稀疏矩阵分块方法对所述联合误差观测模型进行简化求解,求得第二历元时刻状态向量相对于状态向量初值的浮点改正数;
浮点解计算模块,用于根据所述浮点改正数以及所述联合误差观测模型,确定待解算的所述状态向量在第二历元时刻的浮点解及其协方差矩阵。
基线向量定位模块,用于根据基线向量浮点解及其协方差矩阵进行定位。
在一个实施例中,浮点改正数计算模块和浮点解计算模块进一步用于:
利用对角矩阵Pk+1和Hk+1对HT k+1Pk+1进行简化计算表示如下:
Figure GDA0002639468260000211
根据所述
Figure GDA0002639468260000212
Figure GDA0002639468260000213
进行简化表示如下:
Figure GDA0002639468260000214
其中,
Figure GDA0002639468260000215
根据所述
Figure GDA0002639468260000216
Figure GDA0002639468260000217
进行简化计算表示如下:
Figure GDA0002639468260000218
其中,
Figure GDA0002639468260000219
根据简化计算得到的所述
Figure GDA00026394682600002110
Figure GDA00026394682600002111
确定待解算的所述状态向量在第二历元时刻的浮点解及其协方差矩阵;
其中,所述浮点解表示如下:
Xk+1=Xk+1|k+dx
上式中,浮点改正数dx表示如下:
Figure GDA00026394682600002112
所述协方差矩阵表示如下:
Figure GDA0002639468260000221
关于GNSS基线向量解算定位装置的具体限定可以参见上文中对于GNSS基线向量解算定位方法的限定,在此不再赘述。上述GNSS基线向量解算定位装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
本发明的GNSS基线向量解算定位装置与本发明的GNSS基线向量解算定位方法一一对应,在上述GNSS基线向量解算定位方法的实施例阐述的技术特征及其有益效果均适用于GNSS基线向量解算定位装置的实施例中,特此声明。
在一个实施例中,提供了一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,处理器执行计算机程序时实现如上任意一个实施例所述GNSS基线向量解算定位方法的步骤。
上述计算机设备,其处理器执行程序时,通过实现如上步骤,从而可以根据获取的观测数据,构建第一误差观测方程和第二误差观测方程得到的联合误差观测方程,求解得到基线向量浮点解及其协方差矩阵进行定位。本发明的上述基线向量解算定位方法不涉及传统的卡尔曼滤波增益矩阵的计算,解决传统卡尔曼滤波基线解算在观测卫星数增多时,增益矩阵运算量显著增多,导致基线解算定位效率显著下降的问题,有效提升了GNSS基线向量浮点解的获取效率,从而提升了定位效率。
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现如上任意一个实施例所述GNSS基线向量解算定位方法的步骤。
上述计算机可读存储介质,其上存储的计算机程序被处理器执行时,通过实现如上步骤,从而可以根据获取的观测数据,构建第一误差观测方程和第二误差观测方程得到的联合误差观测方程,求解得到基线向量浮点解及其协方差矩阵进行定位。本发明的上述基线向量解算定位方法不涉及传统的卡尔曼滤波增益矩阵的计算,解决传统卡尔曼滤波基线解算在观测卫星数增多时,增益矩阵运算量显著增多,导致基线解算定位效率显著下降的问题,有效提升了GNSS基线向量浮点解的获取效率,从而提升了定位效率。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本发明所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(ROM)、可编程ROM(PROM)、电可编程ROM(EPROM)、电可擦除可编程ROM(EEPROM)或闪存。易失性存储器可包括随机存取存储器(RAM)或者外部高速缓冲存储器。作为说明而非局限,RAM以多种形式可得,诸如静态RAM(SRAM)、动态RAM(DRAM)、同步DRAM(SDRAM)、双数据率SDRAM(DDRSDRAM)、增强型SDRAM(ESDRAM)、同步链路(Synchlink)DRAM(SLDRAM)、存储器总线(Rambus)直接RAM(RDRAM)、直接存储器总线动态RAM(DRDRAM)、以及存储器总线动态RAM(RDRAM)等。
一种导航定位设备,其特征在于,所述导航定位设备在进行导航定位时执行如上任一实施例所述的GNSS基线向量解算定位方法的步骤。
上述导航定位设备,在进行导航定位时,通过实现如上任一实施例所述的GNSS基线向量解算定位方法的步骤,从而可以根据获取的观测数据,构建第一误差观测方程和第二误差观测方程得到的联合误差观测方程,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。本发明的上述基线向量浮点解获取方法不涉及传统的卡尔曼滤波增益矩阵的计算,解决传统卡尔曼滤波基线解算在观测卫星数增多时,增益矩阵运算量显著增多,导致基线解算定位效率显著下降的问题,有效提升了GNSS基线向量浮点解的获取效率,从而提升了定位效率。
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。

Claims (10)

1.一种GNSS基线向量解算定位方法,其特征在于,所述方法包括:
根据获取的观测数据,构建第一误差观测模型;
根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型;
根据第一误差观测模型和第二误差观测模型,得到联合误差观测模型;
根据所述联合误差观测模型,求得基线的浮点解及其协方差矩阵,根据所述基线的浮点解及其协方差矩阵进行定位。
2.根据权利要求1所述的GNSS基线向量解算定位方法,其特征在于,所述根据获取的观测数据,构建第一误差观测模型的步骤包括:
根据获取的观测数据,构建第二历元时刻的基本误差观测模型;
以状态向量在第二历元时刻的状态预测向量作为第二历元时刻所述状态向量的近似值,对所述基本误差观测模型进行线性化处理,得到第一误差观测模型;其中,所述第一误差观测模型包括观测向量的残差向量、第一误差观测模型的设计矩阵和第一误差观测模型的权阵。
3.根据权利要求1所述的GNSS基线向量解算定位方法,其特征在于,所述根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型包括:
根据状态向量的先验信息,构建虚拟观测模型,其中,所述虚拟观测模型包括状态向量在第二历元时刻的虚拟观测值向量和虚拟观测模型的权阵;
以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型,其中,所述第二误差观测模型包括状态向量的残差向量和第二误差观测模型的权阵。
4.根据权利要求1所述的GNSS基线向量解算定位方法,其特征在于,所述根据第一误差观测模型和第二误差观测模型,得到联合误差观测模型包括:
联合第一误差观测模型和第二误差观测模型得到基本联合误差观测模型;
根据最小二乘平差原理,对所述基本联合误差观测模型进行简化处理,得到联合误差观测模型。
5.根据权利要求4所述的GNSS基线向量解算定位方法,其特征在于,所述第一误差观测模型的权阵为分块对角矩阵;
所述根据所述联合误差观测模型,求得基线的浮点解及其协方差矩阵的步骤包括:
采用稀疏矩阵分块方法对所述联合误差观测模型进行简化求解,求得第二历元时刻状态向量相对于状态向量初值的浮点改正数;并
根据所述浮点改正数以及所述联合误差观测模型,确定待解算的所述状态向量在第二历元时刻的浮点解及其协方差矩阵。
6.根据权利要求5所述的GNSS基线向量解算定位方法,其特征在于,所述第一误差观测模型表示如下:
Vobs=Hk+1·dx-(Zk+1-f(Xk+1|k)),
Figure FDA0002580940440000021
上式中,k为第一历元时刻,k+1为第二历元时刻,Vobs为观测向量的残差向量,Hk+1为第二历元时第一误差观测模型的设计矩阵,Zk+1为第二历元时的观测向量,Xk+1|k为第二历元时刻的状态预测向量,f(Xk+1|k)为第二历元时基于状态预测向量计算得到的观测值的计算值向量,Pk+1为第一误差观测模型的权阵,Rk+1为第二历元时观测向量的噪声协方差矩阵;
所述构建的虚拟观测模型表示如下:
Xk+1|k=X+εx
Figure FDA0002580940440000022
上式中,X为状态向量,εx为误差向量,Px为虚拟观测模型的权阵,Qk+1|k为第二历元时状态预测向量的噪声协方差矩阵;
所述第二误差观测模型表示如下:
Vx=I·dx,
Figure FDA0002580940440000023
上式中,Vx为状态向量的残差向量,I为单位阵,dx为第二历元时状态向量X以预测向量Xk+1|k作为初值的改正数向量;
所述基本联合误差观测模型表示如下:
Figure FDA0002580940440000024
根据最小二乘平差原理,对所述基本联合误差观测模型进行简化处理,得到的联合误差观测模型表示如下:
Figure FDA0002580940440000031
7.根据权利要求6所述的GNSS基线向量解算定位方法,其特征在于,所述第二历元时观测向量的噪声协方差矩阵表示如下:
Figure FDA0002580940440000032
上式中,Q为观测向量的先验方差阵,上标P表示伪距,上标L表示载波,下标gps、glo、bds和gal依次表示GPS卫星导航系统、Glonass卫星导航系统、BDS卫星导航系统和Galileo卫星导航系统;
所述第二历元时第一误差观测模型的设计矩阵表示如下:
Figure FDA0002580940440000033
上式中,A为状态向量非模糊度坐标参数部分对应的设计矩阵,B为状态向量模糊度参数部分对应的设计矩阵;
所述采用稀疏矩阵分块方法对所述联合误差观测模型进行简化求解,求得第二历元时刻状态向量相对于状态向量初值的浮点改正数;并根据所述浮点改正数以及所述联合误差观测模型,确定待解算的所述状态向量在第二历元时刻的浮点解及其协方差矩阵包括步骤:
利用对角矩阵Pk+1和Hk+1
Figure FDA0002580940440000034
进行简化表示如下:
Figure FDA0002580940440000041
根据所述
Figure FDA0002580940440000042
Figure FDA0002580940440000043
进行简化表示如下:
Figure FDA0002580940440000044
其中,
Figure FDA0002580940440000045
根据所述
Figure FDA0002580940440000046
Figure FDA0002580940440000047
进行简化表示如下:
Figure FDA0002580940440000048
其中,
Figure FDA0002580940440000049
根据简化计算得到的所述
Figure FDA00025809404400000410
Figure FDA00025809404400000411
确定待解算的所述状态向量在第二历元时刻的浮点解及其协方差矩阵;
其中,所述浮点解表示如下:
Xk+1=Xk+1|k+dx
上式中,浮点改正数dx表示如下:
Figure FDA00025809404400000412
所述协方差矩阵表示如下:
Figure FDA0002580940440000051
8.一种GNSS基线向量解算定位装置,其特征在于,所述装置包括:
第一模型构建模块,用于根据获取的观测数据,构建第一误差观测模型;
第二模型构建模块,用于根据待解算状态向量的先验信息,构建虚拟观测模型,以状态预测向量作为虚拟观测模型的虚拟观测值,并将其值作为状态向量的初值,代入所述虚拟观测模型,得到第二误差观测模型;
联合模型构建模块,用于根据第一误差观测模型和第二误差观测模型,得到联合误差观测模型;
基线向量解算定位模块,用于根据所述联合误差观测模型,求得基线的浮点解及其协方差矩阵,根据基线向量浮点解及其协方差矩阵进行定位。
9.一种导航定位设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时执行如权利要求1至7中任一项所述的GNSS基线向量解算定位方法的步骤。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至7中任一项所述的GNSS基线向量解算定位方法的步骤。
CN201810995758.1A 2018-08-29 2018-08-29 Gnss基线向量解算定位方法、装置和导航定位设备 Active CN109085629B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810995758.1A CN109085629B (zh) 2018-08-29 2018-08-29 Gnss基线向量解算定位方法、装置和导航定位设备

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810995758.1A CN109085629B (zh) 2018-08-29 2018-08-29 Gnss基线向量解算定位方法、装置和导航定位设备

Publications (2)

Publication Number Publication Date
CN109085629A CN109085629A (zh) 2018-12-25
CN109085629B true CN109085629B (zh) 2020-11-17

Family

ID=64795016

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810995758.1A Active CN109085629B (zh) 2018-08-29 2018-08-29 Gnss基线向量解算定位方法、装置和导航定位设备

Country Status (1)

Country Link
CN (1) CN109085629B (zh)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109696153B (zh) * 2018-12-25 2021-09-14 广州市中海达测绘仪器有限公司 Rtk倾斜测量精度检测方法和系统
CN109669195B (zh) * 2019-02-14 2022-10-28 上海华测导航技术股份有限公司 一种导航定位方法及装置
CN110703284B (zh) * 2019-09-17 2022-11-29 中国矿业大学 一种基于稀疏核学习的单站gnss瞬时速度和加速度构建方法
CN111239787B (zh) * 2020-02-28 2021-02-02 同济大学 一种集群自主协同中的gnss动态卡尔曼滤波方法
CN114660639A (zh) * 2020-12-23 2022-06-24 千寻位置网络有限公司 定位置信误差模型的确定方法和定位置信误差的确定方法
CN113343163B (zh) * 2021-04-19 2023-03-21 华南农业大学 一种大规模边角网平差及精度评定方法、系统及存储介质
CN114662268B (zh) * 2021-11-02 2023-04-07 广州市城市规划勘测设计研究院 一种改进的gnss网序贯平差计算方法

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104483688A (zh) * 2014-11-03 2015-04-01 中国人民解放军63961部队 基于北斗卫星导航系统的高精度基线解算方法
CN106093991A (zh) * 2016-06-21 2016-11-09 武汉大学 一种用于gnss定位的模糊度快速恢复方法及系统
CN106569241B (zh) * 2016-09-27 2019-04-23 北京航空航天大学 一种基于gnss的单频高精度定位方法
CN107193028B (zh) * 2017-03-29 2020-05-22 中国航空无线电电子研究所 基于GNSS的Kalman相对定位方法

Also Published As

Publication number Publication date
CN109085629A (zh) 2018-12-25

Similar Documents

Publication Publication Date Title
CN109085629B (zh) Gnss基线向量解算定位方法、装置和导航定位设备
AU2010307015B2 (en) System and method for compensating for faulty measurements
CN108802781B (zh) 整周模糊度的获取方法
WO2015099194A1 (ja) 衛星測位システム、測位端末、測位方法、及び記録媒体
CN103728643B (zh) 附有宽巷约束的北斗三频网络rtk模糊度单历元固定方法
CN110646820B (zh) Rtk定位数据的质检方法、装置、设备和存储介质
CN112230252B (zh) 终端定位方法、装置、计算机设备和存储介质
CN104502935A (zh) 一种基于非差非组合模型的网络rtk模糊度解算方法
Zhang et al. A novel GNSS based V2V cooperative localization to exclude multipath effect using consistency checks
EP3647821B1 (en) Positioning method and positioning terminal
CN109597105B (zh) 一种顾及载波系统间偏差的gps/glonass紧组合定位方法
Chu et al. GPS/Galileo long baseline computation: method and performance analyses
Xu et al. A new ionosphere-free ambiguity resolution method for long-range baseline with GNSS triple-frequency signals
CN109856656B (zh) 一种导航定位方法、装置、电子设备及存储介质
CN110907971A (zh) 高空设备的卫星定位方法、装置、计算机设备和存储介质
CN109752747B (zh) 差分数据确定方法、装置、服务器及存储介质
US11112508B2 (en) Positioning method and positioning terminal
US9769606B2 (en) Systems and methods for determining network access point locations
JP7038281B2 (ja) 測位方法および測位端末
KR101854819B1 (ko) Gps(global positioning system) 수신기의 필터링
JP4928114B2 (ja) キャリア位相相対測位装置
US11294072B2 (en) Method, device and server for estimation of IFB calibration value
CN112987048A (zh) 一种适用于Andriod智能终端的高精度定位方法、智能终端以及存储介质
Li et al. Real-time kinematic positioning using fused data from multiple GNSS antennas
CN116931007B (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
GR01 Patent grant
GR01 Patent grant