CN104777498B - 一种基于卡尔曼滤波的gnss单点定位的方法及装置 - Google Patents
一种基于卡尔曼滤波的gnss单点定位的方法及装置 Download PDFInfo
- Publication number
- CN104777498B CN104777498B CN201510199753.4A CN201510199753A CN104777498B CN 104777498 B CN104777498 B CN 104777498B CN 201510199753 A CN201510199753 A CN 201510199753A CN 104777498 B CN104777498 B CN 104777498B
- Authority
- CN
- China
- Prior art keywords
- state value
- matrix
- speed
- prediction
- moment
- 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
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/42—Determining position
-
- 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/40—Correcting position, velocity or attitude
Abstract
本发明提供了一种基于卡尔曼滤波的GNSS单点定位的方法及装置,包括:分别建立卡尔曼滤波的动态模型和观测模型;根据建立的动态模型和观测模型,分别获取第一预测的状态值和第一预测的状态值的方差矩阵;根据获得的第一预测的状态值的方差矩阵、设计矩阵和观测误差方差阵,计算增益矩阵;根据获得的第一预测的状态值和设计矩阵、观测值以及增益矩阵计算第二预测的状态值;根据获得的第一预测的状态值的方差矩阵、增益矩阵和设计矩阵,计算第二预测的状态值的方差矩阵;获取平滑速度,根据获得的平滑速度和第二预测的状态值以及第二预测的状态值的方差矩阵计算下一时刻的状态值及状态值的方差矩阵。本发明技术方案提高了定位结果的精度和可用性。
Description
技术领域
本发明涉及卫星导航领域,尤指一种基于卡尔曼滤波的全球卫星导航定位系统(GNSS)单点定位的方法及装置。
背景技术
目前,全球卫星导航定位系统(GNSS)由美国的全球卫星定位系统(GPS),俄罗斯的格洛纳斯卫星导航系统(GLONASS),中国的北斗导航系统(BeiDou)以及欧盟的Galileo卫星导航系统组成。其中GPS和GLONASS系统已经全部建设完成,具备全球定位的功能。中国的BeiDou目前已经发射了16颗卫星,其中包括5颗中地球轨道(MEO,Medium Earth Orbit)卫星,5颗倾斜地球同步轨道(IGSO,Inclined Geosynchronous Satellite Orbit)卫星和6颗地球静止轨道(GEO,Geostationary Earth Orbit)卫星,实现了亚太地区的定位功能。欧盟的Galileo系统则有四颗卫星可用。日本和印度也在研制自己的区域卫星导航定位系统。不难看出,GNSS行业目前发展势头迅猛,已经形成了产业化,因而可靠的导航定位算法及结果则显得尤为重要。
传统的GNSS单点定位方法采用最小二乘估计,由单个历元的观测量,通过所建立的观测模型和随机模型,根据加权残差平方和最小的原则,估计出相对于初始坐标的坐标增量,从而得到最终的坐标及其他一起估计的参数,如钟差等。其中,建立的观测模型如公式(1)所示:
zk=Hxk+εk (1)
建立的随机模型如公式(2)所示:
p(εk)~N(0,R) (2)
其中,zk为接收机在k时刻的观测值(GNSS单点定位中的观测量减去可计算出来的已知值)。xk表示接收机在k时刻的状态值,εk表示观测模型的随机误差,R表示观测误差方差阵,H表示设计矩阵,N(0,R)表示随机误差服从0期望和R方差。
从理论上来讲,所估计的坐标值的确是根据已有的观测信息得出的最优值。在观测量可靠的情况下,由最小二乘所得到的定位结果基本可以稳定在米级,满足大多数的应用。然而,在一些复杂场景下,如信号重捕,高楼遮挡,过桥等,观测量有限且观测质量比较差,此时的定位结果一般都存在较大的偏差,严重降低了定位结果的可用性。
发明内容
为了解决上述技术问题,本发明提供了一种基于卡尔曼滤波的全球卫星导航定位系统(GNSS)单点定位的方法及装置,能够提高定位结果的精度和可用性。
为了达到本发明目的,本发明提供了一种基于卡尔曼滤波的GNSS单点定位的方法,包括:
根据动态误差方差阵和状态转移矩阵建立卡尔曼滤波的动态模型以及根据观测误差方差阵和设计矩阵建立卡尔曼滤波的观测模型;
根据建立的卡尔曼滤波的动态模型和观测模型,分别获取第一预测的状态值和第一预测的状态值的方差矩阵;
根据获得的第一预测的状态值的方差矩阵、设计矩阵和观测误差方差阵,计算增益矩阵;
根据获得的第一预测的状态值和设计矩阵、观测值以及增益矩阵计算第二预测的状态值;根据获得的第一预测的状态值的方差矩阵、增益矩阵和设计矩阵,计算第二预测的状态值的方差矩阵;
获取平滑速度,根据获得的平滑速度和第二预测的状态值以及第二预测的状态值的方差矩阵计算下一时刻的状态值及状态值的方差矩阵。
进一步地,按照下式建立所述动态模型:
xk=Фxk-1+wk-1;
按照下式建立所述观测模型:
zk=Hxk+εk;
其中,xk-1和xk分别表示接收机在(k-1)时刻和k时刻的状态值,Ф表示状态转移矩阵,H为设计矩阵,zk为接收机在k时刻的观测值;wk-1和εk分别表示动态模型的随机误差和观测模型的随机误差,并且分别服从下列分布:
p(wk-1)~N(0,Q)
p(εk)~N(0,R)
Q和R分别表示动态误差方差阵和观测误差方差阵。
进一步地,按照下式获取第一预测的状态值:
按照下式获取第一预测的状态值的方差矩阵;
其中,Q表示动态误差方差阵,Ф表示状态转移矩阵,表示接收机在(k-1)时刻的状态值,Pk-1表示接收机在(k-1)时刻的状态值的方差矩阵。
进一步地,按照下式计算所述增益矩阵:
其中,表示接收机在k时刻的第一预测的状态值的方差矩阵,R表示观测误差方差阵,H为设计矩阵。
进一步地,按照下式获取所述第二预测的状态值:
按照下式获取所述第二预测的状态值的方差矩阵:
其中,I表示单位矩阵,表示接收机在k时刻的第一预测的状态值,表示接收机在k时刻的第一预测的状态值的方差矩阵,Kk表示增益矩阵。
进一步地,按照下式计算下一时刻的状态值:
按照下式计算下一时刻的状态值的方差矩阵:
其中,表示在k时刻获得的接收机的平滑速度,t表示k时刻到(k+1)时刻之间的时间间隔,表示在k时刻获得的接收机的平滑速度的方差矩阵,表示接收机在k时刻的第二预测的状态值。
进一步地,所述获取平滑速度包括:获取当前时刻和当前时刻之前的两个时刻的速度;
为获得的各个速度分配权重值,其中分配的权重值之和为1;
根据获得的各个速度和分配的权重值,计算平滑速度。
本发明还提供了一种基于卡尔曼滤波的GNSS单点定位的装置,包括:建模模块、第一获取模块、第一计算模块、第二获取模块和第二计算模块;其中,
建模模块,用于根据动态误差方差阵和状态转移矩阵建立卡尔曼滤波的动态模型以及根据观测误差方差阵和设计矩阵建立卡尔曼滤波的观测模型;
第一获取模块,用于根据建立的卡尔曼滤波的动态模型和观测模型,分别获得第一预测的状态值和第一预测的状态值的方差矩阵;
第一计算模块,用于根据获得的第一预测的状态值的方差矩阵、设计矩阵和观测误差方差阵,计算增益矩阵;
第二获取模块,用于根据获得的第一预测的状态值和设计矩阵、观测值以及增益矩阵计算第二预测的状态值;根据获得的第一预测的状态值的方差矩阵、增益矩阵和设计矩阵,计算第二预测的状态值的方差矩阵;
第二计算模块,用于获取平滑速度,根据获得的平滑速度和第二预测的状态值以及第二预测的状态值的方差矩阵计算下一时刻的状态值及状态值的方差矩阵。
进一步地,上述第二计算模块获取平滑速度,包括:获取当前时刻和当前时刻之前的两个时刻的速度;
为获得的各个速度分配权重值,其中分配的权重值之和为1;
根据获得的各个速度和分配的权重值,计算平滑速度。
本发明技术方案包括:根据动态误差方差阵和状态转移矩阵建立卡尔曼滤波的动态模型以及根据观测误差方差阵和设计矩阵建立卡尔曼滤波的观测模型;根据建立的卡尔曼滤波的动态模型和观测模型,分别获取第一预测的状态值和第一预测的状态值的方差矩阵;根据获得的第一预测的状态值的方差矩阵、设计矩阵和观测误差方差阵,计算增益矩阵;根据获得的第一预测的状态值和设计矩阵、观测值以及增益矩阵计算第二预测的状态值;根据获得的第一预测的状态值的方差矩阵、增益矩阵和设计矩阵,计算第二预测的状态值的方差矩阵;获取平滑速度,根据获得的平滑速度和第二预测的状态值以及第二预测的状态值的方差矩阵计算下一时刻的状态值及状态值的方差矩阵。本发明技术方案提高了定位结果的精度和可用性。
附图说明
此处所说明的附图用来提供对本发明的进一步理解,构成本申请的一部分,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为本发明基于卡尔曼滤波的GNSS单点定位的方法的流程图;
图2为本发明基于卡尔曼滤波的GNSS单点定位的装置的结构示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明白,下文中将结合附图对本发明的实施例进行详细说明。需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互任意组合。
图1为本发明基于卡尔曼滤波的GNSS单点定位的方法的流程图,如图1所示,包括:
步骤101:根据动态误差方差阵和状态转移矩阵建立卡尔曼滤波的动态模型以及根据观测误差方差阵和设计矩阵建立卡尔曼滤波的观测模型。
其中,分别按照公式(1.1)和(1.2)建立动态模型和观测模型:
xk=Фxk-1+wk-1 (1.1)
zk=Hxk+εk (1.2)
其中,xk-1和xk分别表示接收机在(k-1)时刻和k时刻的状态值,Ф表示状态转移矩阵,H为设计矩阵,zk为接收机在k时刻的观测值;wk-1和εk分别表示动态模型的随机误差和观测模型的随机误差,并且分别服从下列分布:
p(wk-1)~N(0,Q)
p(εk)~N(0,R)
Q和R表示动态误差方差阵和观测误差方差阵。
需要说明的是,Ф是根据接收机实时的动态情况获取的,H则是在给定接收机位置x初值的情况下,对卫星到接收机间的几何距离进行线性化得到的。在给定接收机位置x初值的情况下,xk-1和xk可以根据公式(1.1)进行推导。关于如何获取以及计算Ф和H以及计算Q和R,属于本领域技术人员所熟知的惯用技术手段,并不用来限制本发明,在此不再赘述。zk为观测值,可以由GNSS单点定位中的观测量减去可计算出来的已知值获得,其中,GNSS的观测量可以从接收机中获得,计算出来的已知值是由接收机位置初值x来求得的卫星至接收机间的几何距离。
步骤102:根据建立的卡尔曼滤波的动态模型和观测模型,分别获取第一预测的状态值和第一预测的状态值的方差矩阵。
其中,分别按照公式(1.3)和公式(1.4)获取第一预测的状态值和第一预测的状态值的方差矩阵:
其中,Q表示动态误差方差阵,Ф表示状态转移矩阵,表示接收机在(k-1)时刻的状态值,Pk-1表示接收机在(k-1)时刻的状态值的方差矩阵。
步骤103:根据获得的第一预测的状态值的方差矩阵、设计矩阵和观测误差方差阵,计算增益矩阵。
其中,按照公式(1.5)计算增益矩阵:
其中,表示接收机在k时刻的第一预测的状态值的方差矩阵,R表示观测误差方差阵,H为设计矩阵。
步骤104:根据获得的第一预测的状态值和设计矩阵、观测值以及增益矩阵计算第二预测的状态值;根据获得的第一预测的状态值的方差矩阵、增益矩阵和设计矩阵,计算第二预测的状态值的方差矩阵。
其中,分别按照公式(1.6)和(1.7)获取所述第二预测的状态值和第二预测的状态值的方差矩阵:
其中,I表示单位矩阵,表示接收机在k时刻的第一预测的状态值,表示接收机在k时刻的第一预测的状态值的方差矩阵,Kk表示增益矩阵。
步骤105:获取平滑速度,根据获得的平滑速度和第二预测的状态值以及第二预测的状态值的方差矩阵计算下一时刻的状态值及状态值的方差矩阵。
其中,分别按照公式(1.8)和(1.9)计算下一时刻的状态值及方差矩阵:
其中,表示在k时刻获得的接收机的平滑速度,t表示k时刻到(k+1)时刻之间的时间间隔,表示在k时刻获得的接收机的平滑速度的方差矩阵,表示接收机在k时刻的第二预测的状态值。
本步骤中的获取平滑速度包括:获取当前时刻和当前时刻之前的两个时刻的速度;
为获得的各个速度分配权重值,其中分配的权重值之和为1;
根据获得的各个速度和分配的权重值,计算平滑速度。
需要说明的是,关于如何为各个速度分配权重值可以根据实际需要进行分配,例如可以都为1/3;另外,本领域技术人员也可以根据实际的应用情况确定选择几个连续时刻的速度进行速度平滑。
举例说明,对于有惯性导航系统(INS)集成的GNSS系统,速度可以由INS给出,不受观测环境的影响,该卡尔曼滤波则可以实现可靠的定位,甚至可以扩展到运用加速度来进行速度的预测,然后再对坐标进行预测。而对于单纯的GNSS系统,瞬时速度一般由多普勒观测值可以估计求得,或者是由历元间的相位观测值差分进行估计。在较差的观测环境下,速度的估计值精度也变差,从而导致卡尔曼滤波的状态预测值精度下降。因此,需要适当的对复杂场景下(可根据卫星数或者DOP值进行判断)估计的速度进行平滑。平滑的方法如公式(2.0)和(2.1)所示:
其中,表示平滑后的速度,表示接收机在k时刻的速度,表示接收机在(k-1)时刻的速度,接收机在(k-2)时刻的速度,a,b和c表示用当前和之前两个历元速度的权重,并且符合a+b+c=1。鉴于较早的历史速度对当前速度的作用影响很小,只有最近的几个历元的速度参考价值较大,用户可以自己设置a,b和c的大小,例如可以取a=b=c=1/3;例如也可以取a=0,b=c=0.5;a=1,b=c=0;用户也可以根据自己的情况来选择用多少个历元(不限于本发明中所提到的3个历元)来进行速度平滑。
然而在实际应用中,速度的变化量,即加速度值,也需要进行考虑。单纯的GNSS系统无法获得加速度值,因此可以通过连续两个历元的速度变化量来求得。除非在高动态情况下(一般这种情况下观测环境受遮挡较小),该速度的变化量也有一定的限值。比如说在车载应用中,一般情况下速度的变化量都会在一个重力加速度范围以内。因此可以对速度的变化量加以限制(以车载导航为例):
其中,g为重力加速度。当速度的变化量在一个g的范围之内时,表示速度的估计值比较可靠,不需要进行速度平滑,即相当于上述的a=1,b=c=0的取值情况;当速度的变化量超出一个g的范围时,当前的速度估计值不可靠,需要用式(2.0)和(2.1)来进行速度平滑以求得当前历元的速度值,同时当前时刻的速度权重值需要设置为0,之前两个历元的权重值也相应的需要进行调整,如均设置为0.5,即相当于上述的a=0,b=c=0.5的取值情况。这样,相对可靠的速度加上所建立的卡尔曼滤波模型就可以提高我们在观测环境条件较差环境下的定位精度和可靠性。
本发明通过采用卡尔曼滤波(公式1.1-1.7),运用速度来预测下个历元的位置及其方差(公式1.8-1.9),然后通过GNSS观测量来更新定位估计的结果及其方差,从而使各个历元间的定位结果通过速度联系起来,增加了定位的可靠性及其精度。此外,由于复杂场景下的速度估计也存在偏差,本发明方法对复杂场景下的速度进行平滑(公式2.0-2.1),提高了速度的可靠性,然后再用于位置预测,从而改善定位结果。
图2为本发明基于卡尔曼滤波的GNSS单点定位的装置的结构示意图,如图2所示,包括:建模模块、第一获取模块、第一计算模块、第二获取模块和第二计算模块;其中,
建模模块,用于根据动态误差方差阵和状态转移矩阵以及观测误差方差阵和设计矩阵分别建立卡尔曼滤波的动态模型和观测模型。
其中,建模模块,具体用于分别按照公式(1.1)和(1.2)建立动态模型和观测模型。
第一获取模块,用于根据建立的卡尔曼滤波的动态模型和观测模型,分别获取第一预测的状态值和第一预测的状态值的方差矩阵。
其中,第一获取模块,具体用于分别按照公式(1.3)和公式(1.4)获取第一预测的状态值和第一预测的状态值的方差矩阵。
第一计算模块,用于根据获得的第一预测的状态值的方差矩阵、设计矩阵和观测误差方差阵,计算增益矩阵。
其中,第一计算模块,具体用于按照公式(1.5)计算所述增益矩阵。
第二获取模块,用于根据获得的第一预测的状态值和设计矩阵、观测值以及增益矩阵计算第二预测的状态值;根据获得的第一预测的状态值的方差矩阵、增益矩阵和设计矩阵,计算第二预测的状态值的方差矩阵。
其中,第二获取模块分别按照公式(1.6)和(1.7)获取第二预测的状态值和第二预测的状态值的方差矩阵。
第二计算模块,用于获取平滑速度,根据获得的平滑速度和第二预测的状态值以及第二预测的状态值的方差矩阵计算下一时刻的状态值及状态值的方差矩阵。
其中,第二计算模块,具体用于分别按照公式(1.8)和(1.9)计算下一时刻的状态值及方差矩阵。
另外,第二计算模块获取平滑速度,包括:获取当前时刻和当前时刻之前的两个时刻的速度;
为获得的各个速度分配权重值,其中分配的权重值之和为1;
根据获得的各个速度和分配的权重值,计算平滑速度。
本领域普通技术人员可以理解上述方法中的全部或部分步骤可通过程序来指令相关硬件完成,所述程序可以存储于计算机可读存储介质中,如只读存储器、磁盘或光盘等。可选地,上述实施例的全部或部分步骤也可以使用一个或多个集成电路来实现。相应地,上述实施例中的各模块/单元可以采用硬件的形式实现,也可以采用软件功能模块的形式实现。本申请不限制于任何特定形式的硬件和软件的结合。
以上所述,仅为本发明的较佳实例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (6)
1.一种基于卡尔曼滤波的全球卫星导航定位系统GNSS单点定位的方法,其特征在于,包括:
根据动态误差方差阵和状态转移矩阵建立卡尔曼滤波的动态模型以及根据观测误差方差阵和设计矩阵建立卡尔曼滤波的观测模型;
根据建立的卡尔曼滤波的动态模型和观测模型,分别获取第一预测的状态值和第一预测的状态值的方差矩阵;
根据获得的第一预测的状态值的方差矩阵、设计矩阵和观测误差方差阵,计算增益矩阵;
根据获得的第一预测的状态值和设计矩阵、观测值以及增益矩阵计算第二预测的状态值;根据获得的第一预测的状态值的方差矩阵、增益矩阵和设计矩阵,计算第二预测的状态值的方差矩阵;
获取平滑速度,根据获得的平滑速度和第二预测的状态值以及第二预测的状态值的方差矩阵计算下一时刻的状态值及状态值的方差矩阵;其中,
获取平滑速度包括:获取当前时刻和当前时刻之前的两个时刻的速度;为获得的各个速度分配权重值,其中分配的权重值之和为1;根据获得的各个速度和分配的权重值,计算平滑速度;按照下式计算平滑速度:
其中,表示k时刻平滑后的速度,表示接收机在k时刻的速度,表示接收机在(k-1)时刻的速度,接收机在(k-2)时刻的速度,a,b和c表示用当前和之前两个历元速度的权重;
计算平滑速度时考虑加速度值,加速度值通过连续两个历元的速度变化量来求得;当速度的变化量在一个重力加速度的范围之内时,设置a=1,b=c=0;当速度的变化量超出一个重力加速度的范围时,设置a=0,b=c=0.5;
按照下式计算下一时刻的状态值:
按照下式计算下一时刻的状态值的方差矩阵:
其中,表示接收机在k时刻的第二预测的状态值,t表示k时刻到(k+1)时刻之间的时间间隔,Φ表示状态转移矩阵,Pk表示接收机在k时刻的状态值的方差矩阵,表示在k时刻获得的接收机的平滑速度的方差矩阵,Q表示动态误差方差阵。
2.根据权利要求1所述的方法,其特征在于,按照下式建立所述动态模型:
xk=Φxk-1+wk-1;
按照下式建立所述观测模型:
zk=Hxk+εk;
其中,xk-1和xk分别表示接收机在(k-1)时刻和k时刻的状态值,H为设计矩阵,zk为接收机在k时刻的观测值;wk-1和εk分别表示动态模型的随机误差和观测模型的随机误差,并且分别服从下列分布:
p(wk-1)~N(0,Q)
p(εk)~N(0,R)
Q和R分别表示动态误差方差阵和观测误差方差阵。
3.根据权利要求1或2所述的方法,其特征在于,按照下式获取第一预测的状态值:
按照下式获取第一预测的状态值的方差矩阵;
其中,表示接收机在(k-1)时刻的状态值,Pk-1表示接收机在(k-1)时刻的状态值的方差矩阵。
4.根据权利要求3所述的方法,其特征在于,按照下式计算所述增益矩阵:
其中,表示接收机在k时刻的第一预测的状态值的方差矩阵,R表示 观测误差方差阵,H为设计矩阵。
5.根据权利要求4所述的方法,其特征在于,按照下式获取所述第二预测的状态值:
按照下式获取所述第二预测的状态值的方差矩阵:
其中,I表示单位矩阵,表示接收机在k时刻的第一预测的状态值,表示接收机在k时刻的第一预测的状态值的方差矩阵,Kk表示增益矩阵。
6.一种基于卡尔曼滤波的全球卫星导航定位系统GNSS单点定位的装置,其特征在于,包括:建模模块、第一获取模块、第一计算模块、第二获取模块和第二计算模块;其中,
建模模块,用于根据动态误差方差阵和状态转移矩阵建立卡尔曼滤波的动态模型以及根据观测误差方差阵和设计矩阵建立卡尔曼滤波的观测模型;
第一获取模块,用于根据建立的卡尔曼滤波的动态模型和观测模型,分别获得第一预测的状态值和第一预测的状态值的方差矩阵;
第一计算模块,用于根据获得的第一预测的状态值的方差矩阵、设计矩阵和观测误差方差阵,计算增益矩阵;
第二获取模块,用于根据获得的第一预测的状态值和设计矩阵、观测值以及增益矩阵计算第二预测的状态值;根据获得的第一预测的状态值的方差矩阵、增益矩阵和设计矩阵,计算第二预测的状态值的方差矩阵;
第二计算模块,用于获取平滑速度,根据获得的平滑速度和第二预测的状态值以及第二预测的状态值的方差矩阵计算下一时刻的状态值及状态值的方差矩阵;其中,
获取平滑速度包括:获取当前时刻和当前时刻之前的两个时刻的速度;为获得的各个速度分配权重值,其中分配的权重值之和为1;根据获得的各个速度和分配的权重值,计算平滑速度;按照下式计算平滑速度:
其中,表示k时刻平滑后的速度,表示接收机在k时刻的速度,表示接收机在(k-1)时刻的速度,接收机在(k-2)时刻的速度,a,b和c表示用当前和之前两个历元速度的权重;
计算平滑速度时考虑加速度值,加速度值通过连续两个历元的速度变化量来求得;当速度的变化量在一个重力加速度的范围之内时,设置a=1,b=c=0;当速度的变化量超出一个重力加速度的范围时,设置a=0,b=c=0.5;
按照下式计算下一时刻的状态值:
按照下式计算下一时刻的状态值的方差矩阵:
其中,表示接收机在k时刻的第二预测的状态值,t表示k时刻到(k+1)时刻之间的时间间隔,Φ表示状态转移矩阵,Pk表示接收机在k时刻的状态值的方差矩阵,表示在k时刻获得的接收机的平滑速度的方差矩阵,Q表示动态误差方差阵。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510199753.4A CN104777498B (zh) | 2015-04-23 | 2015-04-23 | 一种基于卡尔曼滤波的gnss单点定位的方法及装置 |
PCT/CN2015/091867 WO2016169227A1 (zh) | 2015-04-23 | 2015-10-13 | Gnss单点定位的方法及装置 |
EP15889713.2A EP3287811A4 (en) | 2015-04-23 | 2015-10-13 | Method and device for gnss point positioning |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510199753.4A CN104777498B (zh) | 2015-04-23 | 2015-04-23 | 一种基于卡尔曼滤波的gnss单点定位的方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104777498A CN104777498A (zh) | 2015-07-15 |
CN104777498B true CN104777498B (zh) | 2017-11-21 |
Family
ID=53619076
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510199753.4A Active CN104777498B (zh) | 2015-04-23 | 2015-04-23 | 一种基于卡尔曼滤波的gnss单点定位的方法及装置 |
Country Status (3)
Country | Link |
---|---|
EP (1) | EP3287811A4 (zh) |
CN (1) | CN104777498B (zh) |
WO (1) | WO2016169227A1 (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104777498B (zh) * | 2015-04-23 | 2017-11-21 | 和芯星通科技(北京)有限公司 | 一种基于卡尔曼滤波的gnss单点定位的方法及装置 |
CN105891859B (zh) * | 2016-05-23 | 2019-01-15 | 成都市精准时空科技有限公司 | 一种卫星导航pvt解算方法以及相应地芯片、模块 |
CN106772510B (zh) * | 2016-12-15 | 2019-05-31 | 浙江大学 | 一种基于载波相位测量的跳频测距方法 |
CN106956435B (zh) * | 2017-04-18 | 2019-05-07 | 千寻位置网络有限公司 | 3d打印系统及其打印方法 |
CN107990821B (zh) * | 2017-11-17 | 2019-12-17 | 深圳大学 | 一种桥梁形变监测方法、存储介质及桥梁形变监测接收机 |
CN108333604B (zh) * | 2017-12-27 | 2021-07-27 | 和芯星通科技(北京)有限公司 | 一种利用卫星定位的方法和装置、卫星授时方法和装置 |
CN110442142B (zh) * | 2018-05-02 | 2022-12-27 | 北京京东尚科信息技术有限公司 | 速度数据处理方法、装置、电子设备及计算机可读介质 |
CN109696153B (zh) * | 2018-12-25 | 2021-09-14 | 广州市中海达测绘仪器有限公司 | Rtk倾斜测量精度检测方法和系统 |
CN111381261B (zh) * | 2018-12-29 | 2022-05-27 | 广州市泰斗电子科技有限公司 | 一种定位解算方法、装置及卫星导航接收机 |
CN111487660B (zh) * | 2020-04-24 | 2022-07-26 | 北京航空航天大学 | 一种高精度实时微纳卫星集群导航方法 |
CN112590806B (zh) * | 2020-11-30 | 2022-08-30 | 上海欧菲智能车联科技有限公司 | 基于卡尔曼滤波的车辆信息处理方法、装置、设备和介质 |
CN114157578B (zh) * | 2021-11-24 | 2023-10-31 | 北京达佳互联信息技术有限公司 | 网络状态预测方法及装置 |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6331835B1 (en) * | 1999-02-02 | 2001-12-18 | The Charles Stark Draper Laboratory, Inc. | Deeply-integrated adaptive GPS-based navigator with extended-range code tracking |
JP2005221374A (ja) * | 2004-02-05 | 2005-08-18 | Seiko Epson Corp | Gps測位装置 |
JP4165539B2 (ja) * | 2005-07-14 | 2008-10-15 | セイコーエプソン株式会社 | 端末装置、端末装置の制御方法、端末装置の制御プログラム |
EP2037291A1 (en) * | 2007-09-11 | 2009-03-18 | GMV Aerospace and Defence S.A. | Integrity monitoring method for GNSS navigation based on historical information |
DE102008026746A1 (de) * | 2008-06-04 | 2009-12-10 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Verfahren zur Navigation eines Fahrzeuges |
CN101403790B (zh) * | 2008-11-13 | 2013-09-25 | 浙江师范大学 | 单频gps接收机的精密单点定位方法 |
CN102269819B (zh) * | 2010-06-03 | 2013-04-03 | 武汉大学 | 一种用于精密单点定位方法的估计方法 |
EP2690458A4 (en) * | 2011-03-24 | 2014-08-13 | Furukawa Electric Co Ltd | RADAR DEVICE |
KR20130021616A (ko) * | 2011-08-23 | 2013-03-06 | 삼성전자주식회사 | 다중 측위를 이용한 단말의 측위 장치 및 방법 |
CN103529459A (zh) * | 2012-07-05 | 2014-01-22 | 上海映慧电子科技有限公司 | 一种采用单频gps和glonass组合精准定位的方法及其系统 |
US8996311B1 (en) * | 2013-12-06 | 2015-03-31 | Novatel Inc. | Navigation system with rapid GNSS and inertial initialization |
CN104777498B (zh) * | 2015-04-23 | 2017-11-21 | 和芯星通科技(北京)有限公司 | 一种基于卡尔曼滤波的gnss单点定位的方法及装置 |
-
2015
- 2015-04-23 CN CN201510199753.4A patent/CN104777498B/zh active Active
- 2015-10-13 EP EP15889713.2A patent/EP3287811A4/en active Pending
- 2015-10-13 WO PCT/CN2015/091867 patent/WO2016169227A1/zh active Application Filing
Also Published As
Publication number | Publication date |
---|---|
EP3287811A4 (en) | 2018-12-26 |
WO2016169227A1 (zh) | 2016-10-27 |
EP3287811A1 (en) | 2018-02-28 |
CN104777498A (zh) | 2015-07-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104777498B (zh) | 一种基于卡尔曼滤波的gnss单点定位的方法及装置 | |
CN109521448B (zh) | 基于轨道根数预测的星载导航接收机定位授时方法和装置 | |
CN101743453B (zh) | 任务后高精确度定位和定向系统 | |
US20110238308A1 (en) | Pedal navigation using leo signals and body-mounted sensors | |
TW591241B (en) | Improved positioning and data integrating method and system thereof | |
EP2264485A1 (en) | Method for analysing moving object continuous trajectory based on sampled GPS position | |
EP2725322B1 (en) | Smoothed navigation solution using filtered resets | |
CN113203418B (zh) | 基于序贯卡尔曼滤波的gnssins视觉融合定位方法及系统 | |
Zhao | GPS/IMU integrated system for land vehicle navigation based on MEMS | |
CN110988955B (zh) | 一种导航定位的方法及装置 | |
Hide et al. | GPS and low cost INS integration for positioning in the urban environment | |
CN107607971A (zh) | 基于gnss共视时间比对算法的时间频率传递方法及接收机 | |
Georgy | Advanced nonlinear techniques for low cost land vehicle navigation | |
Skaloud et al. | Real-time registration of airborne laser data with sub-decimeter accuracy | |
Li et al. | A tightly coupled positioning solution for land vehicles in urban canyons | |
CN105527639A (zh) | 一种基于平滑与外推的卫星定位方法 | |
Emami et al. | A customized H-infinity algorithm for underwater navigation system: With experimental evaluation | |
Gao et al. | Odometer and MEMS IMU enhancing PPP under weak satellite observability environments | |
Skaloud et al. | Synergy of CP-DGPS, accelerometry and magnetic sensors for precise trajectography in ski racing | |
Zhou | Low-cost MEMS-INS/GPS integration using nonlinear filtering approaches | |
Elsheikh et al. | Low-cost PPP/INS integration for continuous and precise vehicular navigation | |
Nykiel et al. | Precise point positioning method based on wide-lane and narrow-lane phase observations and between satellites single differencing | |
Erfianti et al. | GNSS/IMU Sensor Fusion Performance Comparison of a Car Localization in Urban Environment Using Extended Kalman Filter | |
Petrovska et al. | Aircraft precision landing using integrated GPS/INS system | |
Tien et al. | Adaptive strategy-based tightly-coupled INS/GNSS integration system aided by odometer and barometer |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |