CN111537950B - 一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法 - Google Patents
一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法 Download PDFInfo
- Publication number
- CN111537950B CN111537950B CN202010290207.2A CN202010290207A CN111537950B CN 111537950 B CN111537950 B CN 111537950B CN 202010290207 A CN202010290207 A CN 202010290207A CN 111537950 B CN111537950 B CN 111537950B
- Authority
- CN
- China
- Prior art keywords
- fitting
- positioning result
- polynomial
- time
- track
- 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
- 238000000034 method Methods 0.000 title claims abstract description 49
- 238000001914 filtration Methods 0.000 claims abstract description 9
- 239000011159 matrix material Substances 0.000 claims description 34
- 230000008859 change Effects 0.000 claims description 9
- 230000008569 process Effects 0.000 claims description 8
- 238000012937 correction Methods 0.000 claims description 7
- 238000005259 measurement Methods 0.000 claims description 4
- 230000011664 signaling Effects 0.000 claims description 4
- 230000007704 transition Effects 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 4
- 238000011161 development Methods 0.000 description 3
- 238000002474 experimental method Methods 0.000 description 3
- 238000005315 distribution function Methods 0.000 description 2
- 230000000737 periodic effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0252—Radio frequency fingerprinting
-
- 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0294—Trajectory determination or predictive filtering, e.g. target tracking or Kalman filtering
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
- Y02D30/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明是一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法。所述方法为设置时间窗,通过基于位置指纹的卫星分级定位方法确定时间窗内成员星的N个离散位置构成的轨迹;将时间窗内的N个离散位置作为历史定位结果,根据二步多项式拟合方法确定出N个离散位置的二步多项式拟合值;确定成员星历史定位结果的轨迹吻合度,根据轨迹吻合度确定分级定位轨迹与真实轨迹的偏移程度;计算指纹定位结果,并对指纹定位结果进行卡尔曼滤波,得到成员星最终定位结果。本发明预测跟踪的定位结果的定位误差小于5m的概率为90%,定位误差小于10m的概率约为95%,定位误差小于30m的概率超过95%。定位精度远远高于未跟踪的定位结果。
Description
技术领域
本发明涉及卫星位置预测跟踪技术领域,是一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法。
背景技术
卫星集群是指由多个卫星组成的一个分布式卫星***。其中,选取一颗或若干颗卫星作为基准星,其余卫星为成员星。基准星沿着预设的轨道飞行,成员星跟随基准星进行伴飞。卫星集群自主定位的目的是利用基准星的信息对成员星进行定位。传统的卫星集群自主定位主要针对两个卫星或小规模卫星集群。随着航天任务的任务需求的不断发展,卫星集群成员数量不断增多功能趋向专一化,因此需要研究一种快速、低成本的,并具有集群自主性的定位技术。基于位置指纹的定位方法是一种较为成熟的定位方法,指纹定位***具有成本低、结构简单的特点,因此将指纹定位方法扩展至卫星集群定位中,能够有效减小研制成本,并对卫星集群的协同控制以及卫星技术的发展具有重要意义。
然而,由于卫星集群范围大,不能保证在任意时刻成员星的位置都在距离基准星很近的范围内,因此会造成一些成员星定位结果与真实位置偏离过大的问题,导致定位精度迅速降低。其次,基准星始终在进行周期性的运行之中,基准星之间形成的拓扑结构也呈现周期性的变化。当某时刻基准星的拓扑结构较差时,特别是基准星位于同一平面上时,空间中的信号分布将呈现对称性,同样会导致该时刻的定位结果与实际偏离过大。因此需要对成员星进行跟踪以提高定位精度。
发明内容
本发明为提高定位精度,本发明提供了一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法,本发明提供了以下技术方案:
一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法,包括以下步骤:
步骤1:设置时间窗,从时间窗起始时刻开始,通过基于位置指纹的卫星分级定位方法以一定的时间对成员星进行N次连续定位,确定时间窗内成员星的N个离散位置构成的轨迹;
步骤2:将时间窗内的N个离散位置作为历史定位结果,根据二步多项式拟合方法确定出N个离散位置的二步多项式拟合值;
步骤3:确定成员星历史定位结果的轨迹吻合度,根据轨迹吻合度确定分级定位轨迹与真实轨迹的偏移程度;
步骤4:计算指纹定位结果,并对指纹定位结果进行卡尔曼滤波,得到成员星最终定位结果;
步骤5:将时间窗向成员星运动方向滑动1个单位,根据成员星接收信令判断成员星当前时刻是否存在机动变轨,当不存在机动变轨时,则重复步骤2至步骤4;当存在机动变轨时,则重置时间窗,并将变轨时刻作为时间窗的起始时刻,重复步骤1至步骤4。
优选地,通过基于位置指纹的卫星分级定位方法以一定的时间间对成员星进行N次连续定位,确定时间窗内成员星的N个离散位置构成的轨迹,通过下式表示时间窗内成员星的N个离散位置构成的轨迹:
L=[l1 l2 … lN]T
li=(xi,yi,zi),i=1,2,…,N
其中,L为N个离散位置构成的轨迹,lN为L中第i个位置。
优选地,所述步骤2具体为:
步骤2.1:对时间窗内的N个离散位置的X轴、Y轴和Z轴数据进行拟合计算,得到一部多项式拟合的轨迹方程,通过下式表示一步多项式拟合的轨迹方程:
其中,pn(t)为X轴一步多项式拟合轨迹方程,qn(t)为Y轴一步多项式拟合轨迹方程,rn(t)为Z轴一步多项式拟合轨迹方程;n为一步拟合多项式次数,k为一步拟合多项式次数序号,ak为X轴一步拟合多项式系数,bk为Y轴一步拟合多项式系数,ck为Z轴一步拟合多项式系数,tk为对应的时刻;
确定一步多项式拟合的轨迹,通过下式表示一步多项式拟合的轨迹:
其中,为一步多项式拟合的轨迹,为ti时刻的轨迹的一步多项式拟合值;
步骤2.2:根据一步多项式拟合的轨迹确定历史定位结果和一步多项式拟合值的差值,通过下式表示历史定位结果和一步多项式拟合值的差值:
其中,为历史定位结果和一步多项式拟合值的差值;
根据历史定位结果和一步多项式拟合值的差值确定二步多项式拟合门限值,通过下式表示二步多项式拟合门限值:
其中,median(·)表示求中位数,k为比例常数,η为二步多项式拟合门限值;
步骤2.3:对多项式拟合的过程重新进行拟合,得到二步多项式拟合的轨迹方程,通过下式表示二步多项式拟合的轨迹方程:
其中,为X轴二步多项式拟合轨迹方程,为X轴二步拟合多项式系数,为Y轴二步多项式拟合轨迹方程,为Y轴二步拟合多项式系数,为Z轴二步Z多项式拟合轨迹方程,为Z轴二步拟合多项式系数;
根据多项式函数确定成员星的历史定位结果的二步多项式拟合值,通过下式表示所述二步多项式拟合值:
其中,为成员星历史定位结果的二步多项式拟合值,为第ti时刻的轨迹的二步多项式拟合值。
优选地,确定成员星历史定位结果的轨迹吻合度,通过下式表示所述轨迹吻合度:
其中,w为成员星历史定位结果的轨迹吻合度,I(·)为指示函数,v为成员星的运行速度的大小,c为比例常数;
历史定位结果中偏差大的点增多,拟合位置无法表示真实位置,则吻合度就会降低。
优选地,计算指纹定位结果具体为:确定轨迹吻合度的门限值σ,σ取0.8,当成员星历史定位结果的轨迹吻合度w<σ时,通过基于位置指纹的卫星分级定位方法得到tN+1时刻指纹定位结果,通过下式表示tN+1时刻指纹定位结果:
其中,为tN+1时刻指纹定位结果,为tN+1时刻指纹定位结果X轴坐标,为tN+1时刻指纹定位结果Y轴坐标,为tN+1时刻指纹定位结果Z轴坐标;
当w≥σ时,根据二步拟合得到的多项式函数对tN+1时刻成员星的位置进行预测,得到tN+1时刻成员星的预测位置,通过下式表示所述预测位置:
其中,为tN+1时刻成员星的预测位置;
以tN+1时刻成员星的预测位置为中心,建立边长为l的跟踪区域,将跟踪区域划分成多个边长为l′的小立方体,以每个小立方体的中心为参考点,利用KNN算法得到tN+1时刻指纹定位结果,通过下式表示tN+1时刻指纹定位结果:
优选地,确定成员星最终定位结果具体为:
步骤4.1:通过tN时刻的状态得到tN+1时刻状态的卡尔曼预测值通过下式tN+1时刻状态的表示卡尔曼预测值
XN=[lN v]T
其中,A为状态转移矩阵,XN为tN时刻的状态,lN为tN时刻成员星的定位结果,
计算tN+1时刻的状态协方差矩阵的预测值,通过下式表示tN+1时刻的状态协方差矩阵的预测值:
其中,为tN+1时刻的状态协方差矩阵的预测值,PN表示tN时刻状态协方差矩阵,Q表示过程噪声协方差矩阵;
步骤4.2:将tN+1时刻的指纹定位结果作为观测值,用tN+1时刻的观测值对当前状态的卡尔曼预测值进行修正,从而得到tN+1时刻修正状态XN+1:
其中,K为卡尔曼增益,lN+1为成员星在tN+1时刻最终定位结果,H为观测矩阵,R表示测量噪声协方差矩阵,Z为观测值;
步骤4.3:根据tN+1时刻修正状态XN+1确定成员星在tN+1时刻最终定位结果,通过下式表示成员星在tN+1时刻最终定位结果:
lN+1=(xN+1,yN+1,zN+1)
其中,lN+1为tN+1时刻最终定位结果。
本发明具有以下有益效果:
本发明通过对历史定位结果进行二步拟合并计算轨迹吻合度的方式识别判断历史定位结果是否符合跟踪条件,当符合跟踪条件时,利用二步拟合的轨迹得到当前时刻成员星的预测位置;接下来,根据预测位置确定跟踪区域,在跟踪区域建立跟踪RadioMap并再次进行指纹定位,确定成员星的指纹定位结果,对指纹定位结果进行卡尔曼滤波得到最终的定位结果。
实验结果表明,预测跟踪的定位结果的定位误差小于5m的概率为90%,定位误差小于10m的概率约为95%,定位误差小于30m的概率超过95%。定位精度远远高于未跟踪的定位结果。因此本发明所提出的算法能够大幅度提高定位精度。
附图说明
图1为设置时间窗示意图;
图2为跟踪区域示意图;
图3为种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法流程图;
图4为真实轨迹示意图;
图5为分级定位结果示意图;
图6为预测跟踪结果示意图;
图7为校正前后定位误差CDF曲线图。
具体实施方式
以下结合具体实施例,对本发明进行了详细说明。
具体实施例一:
根据图3所示,本发明提供一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法,包括以下步骤:
一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法,包括以下步骤:
步骤1:设置时间窗,从时间窗起始时刻开始,通过基于位置指纹的卫星分级定位方法以一定的时间对成员星进行N次连续定位,确定时间窗内成员星的N个离散位置构成的轨迹;通过基于位置指纹的卫星分级定位方法以一定的时间间对成员星进行N次连续定位,确定时间窗内成员星的N个离散位置构成的轨迹,通过下式表示时间窗内成员星的N个离散位置构成的轨迹:
L=[l1 l2 … lN]T
li=(xi,yi,zi),i=1,2,…,N
其中,L为N个离散位置构成的轨迹,lN为L中第i个位置。
步骤2:将时间窗内的N个离散位置作为历史定位结果,根据二步多项式拟合方法确定出N个离散位置的二步多项式拟合值;
所述步骤2具体为:
步骤2.1:对时间窗内的N个离散位置的X轴、Y轴和Z轴数据进行拟合计算,得到一部多项式拟合的轨迹方程,通过下式表示一步多项式拟合的轨迹方程:
其中,pn(t)为X轴一步多项式拟合轨迹方程,qn(t)为Y轴一步多项式拟合轨迹方程,rn(t)为Z轴一步多项式拟合轨迹方程;n为一步拟合多项式次数,k为一步拟合多项式次数序号,ak为X轴一步拟合多项式系数,bk为Y轴一步拟合多项式系数,ck为Z轴一步拟合多项式系数,tk为对应的时刻;
确定一步多项式拟合的轨迹,通过下式表示一步多项式拟合的轨迹:
其中,为一步多项式拟合的轨迹,为ti时刻的轨迹的一步多项式拟合值;
步骤2.2:根据一步多项式拟合的轨迹确定历史定位结果和一步多项式拟合值的差值,通过下式表示历史定位结果和一步多项式拟合值的差值:
其中,为历史定位结果和一步多项式拟合值的差值;
根据历史定位结果和一步多项式拟合值的差值确定二步多项式拟合门限值,通过下式表示二步多项式拟合门限值:
其中,median(·)表示求中位数,k为比例常数,η为二步多项式拟合门限值;
步骤2.3:对多项式拟合的过程重新进行拟合,得到二步多项式拟合的轨迹方程,通过下式表示二步多项式拟合的轨迹方程:
其中,为X轴二步多项式拟合轨迹方程,为X轴二步拟合多项式系数,为Y轴二步多项式拟合轨迹方程,为Y轴二步拟合多项式系数,为Z轴二步Z多项式拟合轨迹方程,为Z轴二步拟合多项式系数;
根据多项式函数确定成员星的历史定位结果的二步多项式拟合值,通过下式表示所述二步多项式拟合值:
其中,为成员星历史定位结果的二步多项式拟合值,为第ti时刻的轨迹的二步多项式拟合值。
步骤3:确定成员星历史定位结果的轨迹吻合度,根据轨迹吻合度确定分级定位轨迹与真实轨迹的偏移程度;
确定成员星历史定位结果的轨迹吻合度,通过下式表示所述轨迹吻合度:
其中,w为成员星历史定位结果的轨迹吻合度,I(·)为指示函数,v为成员星的运行速度的大小,c为比例常数;
历史定位结果中偏差大的点增多,拟合位置无法表示真实位置,则吻合度就会降低。
步骤4:计算指纹定位结果,并对指纹定位结果进行卡尔曼滤波,得到成员星最终定位结果;
计算指纹定位结果具体为:确定轨迹吻合度的门限值σ,σ取0.8,当成员星历史定位结果的轨迹吻合度w<σ时,通过基于位置指纹的卫星分级定位方法得到tN+1时刻指纹定位结果,通过下式表示tN+1时刻指纹定位结果:
其中,为tN+1时刻指纹定位结果,为tN+1时刻指纹定位结果X轴坐标,为tN+1时刻指纹定位结果Y轴坐标,为tN+1时刻指纹定位结果Z轴坐标;
当w≥σ时,根据二步拟合得到的多项式函数对tN+1时刻成员星的位置进行预测,得到tN+1时刻成员星的预测位置,通过下式表示所述预测位置:
其中,为tN+1时刻成员星的预测位置;
以tN+1时刻成员星的预测位置为中心,建立边长为l的跟踪区域,将跟踪区域划分成多个边长为l′的小立方体,以每个小立方体的中心为参考点,利用KNN算法得到tN+1时刻指纹定位结果,通过下式表示tN+1时刻指纹定位结果:
确定成员星最终定位结果具体为:
步骤4.1:通过tN时刻的状态得到tN+1时刻状态的卡尔曼预测值通过下式tN+1时刻状态的表示卡尔曼预测值
XN=[lN v]T
其中,A为状态转移矩阵,XN为tN时刻的状态,lN为tN时刻成员星的定位结果,
计算tN+1时刻的状态协方差矩阵的预测值,通过下式表示tN+1时刻的状态协方差矩阵的预测值:
其中,为tN+1时刻的状态协方差矩阵的预测值,PN表示tN时刻状态协方差矩阵,Q表示过程噪声协方差矩阵;
步骤4.2:将tN+1时刻的指纹定位结果作为观测值,用tN+1时刻的观测值对当前状态的卡尔曼预测值进行修正,从而得到tN+1时刻修正状态XN+1:
其中,K为卡尔曼增益,lN+1为成员星在tN+1时刻最终定位结果,H为观测矩阵,R表示测量噪声协方差矩阵,Z为观测值;
步骤4.3:根据tN+1时刻修正状态XN+1确定成员星在tN+1时刻最终定位结果,通过下式表示成员星在tN+1时刻最终定位结果:
lN+1=(xN+1,yN+1,zN+1)
其中,lN+1为tN+1时刻最终定位结果。
步骤5:将时间窗向成员星运动方向滑动1个单位,根据成员星接收信令判断成员星当前时刻是否存在机动变轨,当不存在机动变轨时,则重复步骤2至步骤4;当存在机动变轨时,则重置时间窗,并将变轨时刻作为时间窗的起始时刻,重复步骤1至步骤4。
具体实施例二:
本发明提供一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法,具体包括以下步骤:
步骤1:如图1所示,设置宽度为N的时间窗,从时间窗起始时刻开始,通过基于位置指纹的卫星分级定位方法以一定的时间间隔Δt对成员星进行N次连续定位,得到时间窗内成员星的N个离散位置构成的轨迹L
L=[l1 l2 … lN]T:
其中,li=(xi,yi,zi),i=1,2,…,N,表示轨迹L中第i个位置。对应的时刻为:
T=[t1 t2 … tN]T
步骤2:将时间窗内的N个离散位置作为历史定位结果,根据二步多项式拟合方法计算出这N个离散位置的二步多项式拟合值,具体实施方式如下:
:首先对X轴数据进行拟合。假设X轴拟合多项式为
X轴拟合误差为:
则目标函数为:
显然,Jx是a0,…,an的多元函数。对Jx分别关于每个多项式系数求偏导可得:
令偏导数等于0可得
上式是关于a0,…,an的线性方程组,用矩阵表示为:
根据上式可解出a0,…,an,从而可以得出X轴拟合多项式。同理,对Y轴和Z轴进行拟合,分别得到Y轴拟合多项式和Z轴拟合多项式。于是,可得到一步多项式拟合的轨迹方程:
于是,一步多项式拟合的轨迹可表示为:
其中,表示ti时刻的轨迹的一步多项式拟合值。
计算成员星历史定位结果和一步多项式拟合值之间的差值:
计算二步多项式拟合门限值η:
其中,median(·)表示求中位数,k为比例常数,通常k=2。若则成员星的历史定位结果li以及对应的时刻ti用于后续的二步多项式拟合;若则成员星的历史定位结果li对应的时刻ti不用于后续的二步多项式拟合。
利用确定的用于拟合的历史位置li和对应的时刻ti,按照多项式拟合的过程重新进行拟合,得到二步多项式拟合的轨迹方程:
根据新的多项式函数可以确定成员星的历史定位结果的二步多项式拟合值:
其中,表示第ti时刻的轨迹的二步多项式拟合值。
步骤3:计算成员星历史定位结果的轨迹吻合度w。轨迹吻合度定义如下:
其中,I(·)表示指示函数,v表示成员星的运行速度的大小,c为比例常数,通常c=5。轨迹吻合度表示经过二步曲线拟合之后的拟合位置和历史定位结果之间吻合的程度,历史定位结果中偏差大的点越多,则拟合位置越难以表示真实位置,则吻合度就会越低,反之吻合度越高。因此轨迹吻合度表征分级定位轨迹和真实轨迹之间的偏移程度。
步骤4:计算tN+1时刻的指纹定位结果。首先确定轨迹吻合度门限值σ,通常取σ=0.8;若w<σ,则仍然通过基于位置指纹的卫星分级定位方法得到tN+1时刻指纹定位结果若w≥σ,则符合跟踪条件,按照以下步骤得到tN+1时刻指纹定位结果:
根据二步拟合得到的多项式函数对tN+1时刻成员星的位置进行预测,可得到tN+1时刻成员星的预测位置
以tN+1时刻成员星的预测位置为中心,建立边长为l的跟踪区域,如图2所示。
将跟踪区域划分成多个边长为l′的小立方体,以每个立方体的中心为参考点,根据tN+1时刻的基准星位置,按照信号传播模型计算每个参考点的RSS,建立跟踪Radio Map,利用KNN算法可得到当前时刻指纹定位结果:
对tN+1时刻指纹定位结果进行卡尔曼滤波,得到tN+1时刻最终定位结果。具体实施方式如下:
假定tN时刻的状态为:
XN=[lN v]T
其中,lN=(xN,yN,zN)表示tN时刻成员星的定位结果,v=(vx,vy,vz)表示成员星当前的速度。假设相邻两个时刻之间的时间间隔很小,在这段时间内成员星可近似作匀速直线运动,因此tN+1时刻的成员星位置的卡尔曼预测值和tN时刻的位置lN满足以下近似关系:
因此状态转移矩阵为
于是可以通过tN时刻的状态得到tN+1时刻状态的卡尔曼预测值
其中,
计算tN+1时刻的状态协方差矩阵的预测值
其中,PN表示tN时刻状态协方差矩阵,Q表示过程噪声协方差矩阵。
将tN+1时刻的指纹定位结果作为观测值Z:
用tN+1时刻的观测值对当前状态的卡尔曼预测值进行修正,从而得到tN+1时刻状态XN+1:
其中,lN+1=(xN+1,yN+1,zN+1)为成员星在tN+1时刻最终定位结果,K为卡尔曼增益:
H为观测矩阵通过下式表示:
其中,R表示测量噪声协方差矩阵。从而通过公式获得成员星在tN+1时刻的最终定位结果:
按照下式更新状态协方差矩阵得到tN+1时刻的状态协方差矩阵的最终值:
步骤5:时间窗向成员星运动方向滑动1个单位,并根据成员星接收信令判断成员星当前时刻是否存在机动变轨,若不存在机动变轨,则重复步骤2步骤5过程;若存在机动变轨,则重置时间窗,并将变轨时刻作为时间窗的起始时刻,重复步骤1~步骤5。
如图3所示,基于位置指纹和二步多项式拟合的卫星位置预测跟踪算法主要有三个阶段:分级定位阶段、预测跟踪阶段和滤波阶段。首先需要通过基于位置指纹的卫星分级定位算法得到历史定位结果,然后基于二步多项式拟合计算轨迹吻合度。当符合跟踪条件时,根据预测结果确定跟踪区域,计算跟踪Radio Map,对成员星再次定位,并对定位结果进行卡尔曼滤波;当不符合跟踪条件时,再次利用分级定位算法计算成员星的当前位置,并进行卡尔曼滤波。
为了验证基于位置指纹和二步多项式拟合的卫星位置预测跟踪算法,结合基于位置指纹的卫星集群分级定位算法,对本发明提出的算法进行仿真。本发明进行了多次实验,在每次实验中成员星的轨迹为一条直线,轨迹点的数量为300。本发明设定时间窗的宽度为30,即每次选取30个历史位置进行二步拟合,判断是否满足跟踪条件并进行跟踪。
在某一次实验中,成员星真实轨迹如图4所示。分级定位结果如图5所示,从图中可以看出,由于定位范围大,且稀疏Radio Map的参考点间隔大,因此分级定位算法的定位结果中存在一些偏差特别大的点,从而造成定位精度不高。
而对分级定位结果进行预测跟踪后,定位结果如图6所示。从图6可知,对历史数据进行预测跟踪能够大大提高定位精度。在图5中,有一部分定位结果和真实轨迹的偏差很大,而从图6可知,本发明提出的算法的定位位置和真实轨迹基本重合,从而验证了本发明所提预算法的可靠性。为了分析本发明算法对定位精度的提升,将未进行跟踪的指纹定位误差的累计分布函数和跟踪后的定位误差的累积分布函数进行对比。
从图7中可以看出,跟踪后的定位结果的定位误差明显小于未校正的定位结果的定位误差。分级定位算法的结果中,定位误差小于5m的概率只有68%左右,定位误差小于10m的概率不到80%,定位误差小于30m的概率小于90%。而通过图5可知,预测跟踪的定位结果的定位误差小于5m的概率为90%,定位误差小于10m的概率约为95%,定位误差小于30m的概率超过95%。定位精度远远高于未跟踪的定位结果。可见,本发明所提出的算法能够大幅度提高定位精度。
以上所述仅是一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法的优选实施方式,一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法的保护范围并不仅局限于上述实施例,凡属于该思路下的技术方案均属于本发明的保护范围。应当指出,对于本领域的技术人员来说,在不脱离本发明原理前提下的若干改进和变化,这些改进和变化也应视为本发明的保护范围。
Claims (5)
1.一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法,其特征是:包括以下步骤:
步骤1:设置时间窗,从时间窗起始时刻开始,通过基于位置指纹的卫星分级定位方法以一定的时间对成员星进行N次连续定位,确定时间窗内成员星的N个离散位置构成的轨迹;
步骤2:将时间窗内的N个离散位置作为历史定位结果,根据二步多项式拟合方法确定出N个离散位置的二步多项式拟合值;
所述步骤2具体为:
步骤2.1:对时间窗内的N个离散位置的X轴、Y轴和Z轴数据进行拟合计算,得到一步多项式拟合的轨迹方程,通过下式表示一步多项式拟合的轨迹方程:
其中,pn(t)为X轴一步多项式拟合轨迹方程,qn(t)为Y轴一步多项式拟合轨迹方程,rn(t)为Z轴一步多项式拟合轨迹方程;n为一步拟合多项式次数,k为一步拟合多项式次数序号,ak为X轴一步拟合多项式系数,bk为Y轴一步拟合多项式系数,ck为Z轴一步拟合多项式系数,tk为对应的时刻;
确定一步多项式拟合的轨迹,通过下式表示一步多项式拟合的轨迹:
步骤2.2:根据一步多项式拟合的轨迹确定历史定位结果和一步多项式拟合值的差值,通过下式表示历史定位结果和一步多项式拟合值的差值:
根据历史定位结果和一步多项式拟合值的差值确定二步多项式拟合门限值,通过下式表示二步多项式拟合门限值:
其中,median()表示求中位数,k为比例常数,η为二步多项式拟合门限值;
步骤2.3:对多项式拟合的过程重新进行拟合,得到二步多项式拟合的轨迹方程,通过下式表示二步多项式拟合的轨迹方程:
根据多项式函数确定成员星的历史定位结果的二步多项式拟合值,通过下式表示所述二步多项式拟合值:
步骤3:根据步骤2中的二步多项式拟合值确定成员星历史定位结果的轨迹吻合度,根据轨迹吻合度确定分级定位轨迹与真实轨迹的偏移程度;
步骤4:根据步骤3中的轨迹吻合度计算指纹定位结果,并对指纹定位结果进行卡尔曼滤波,得到成员星最终定位结果;
步骤5:将时间窗向成员星运动方向滑动1个单位,根据成员星接收信令判断成员星当前时刻是否存在机动变轨,当不存在机动变轨时,则重复步骤2至步骤4;当存在机动变轨时,则重置时间窗,并将变轨时刻作为时间窗的起始时刻,重复步骤1至步骤4。
2.根据权利要求1所述的一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法,其特征是:通过基于位置指纹的卫星分级定位方法以一定的时间对成员星进行N次连续定位,确定时间窗内成员星的N个离散位置构成的轨迹,通过下式表示时间窗内成员星的N个离散位置构成的轨迹:
L=[l1 l2 … lN]T
li=(xi,yi,zi),i=1,2,…,N
其中,L为N个离散位置构成的轨迹,lN为L中第i个位置。
4.根据权利要求1所述的一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法,其特征是:计算指纹定位结果具体为:确定轨迹吻合度的门限值σ,σ取0.8,当成员星历史定位结果的轨迹吻合度w<σ时,通过基于位置指纹的卫星分级定位方法得到tN+1时刻指纹定位结果,通过下式表示tN+1时刻指纹定位结果:
当w≥σ时,根据二步拟合得到的多项式函数对tN+1时刻成员星的位置进行预测,得到tN+1时刻成员星的预测位置,通过下式表示所述预测位置:
以tN+1时刻成员星的预测位置为中心,建立边长为l的跟踪区域,将跟踪区域划分成多个边长为l′的小立方体,以每个小立方体的中心为参考点,利用KNN算法得到tN+1时刻指纹定位结果,通过下式表示tN+1时刻指纹定位结果:
5.根据权利要求1所述的一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法,其特征是:确定成员星最终定位结果具体为:
XN=[lN v]T
其中,A为状态转移矩阵,XN为tN时刻的状态,lN为tN时刻成员星的定位结果,
计算tN+1时刻的状态协方差矩阵的预测值,通过下式表示tN+1时刻的状态协方差矩阵的预测值:
步骤4.2:将tN+1时刻的指纹定位结果作为观测值,用tN+1时刻的观测值对当前状态的卡尔曼预测值进行修正,从而得到tN+1时刻修正状态XN+1:
步骤4.3:根据tN+1时刻修正状态XN+1确定成员星在tN+1时刻最终定位结果,通过下式表示成员星在tN+1时刻最终定位结果:
lN+1=(xN+1,yN+1,zN+1)
其中,lN+1为tN+1时刻最终定位结果。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010290207.2A CN111537950B (zh) | 2020-04-14 | 2020-04-14 | 一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010290207.2A CN111537950B (zh) | 2020-04-14 | 2020-04-14 | 一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111537950A CN111537950A (zh) | 2020-08-14 |
CN111537950B true CN111537950B (zh) | 2023-04-21 |
Family
ID=71978667
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010290207.2A Active CN111537950B (zh) | 2020-04-14 | 2020-04-14 | 一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111537950B (zh) |
Family Cites Families (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
BRPI0520295B1 (pt) * | 2005-06-13 | 2019-05-28 | Nokia Technologies Oy | Método e aparelho para suportar o posicionamento baseado em satélite de um dispositivo móvel usando os dados de assistência |
US7310138B2 (en) * | 2005-08-27 | 2007-12-18 | Trimble Navigation, Ltd | Method for augmenting radio positioning system using single fan laser |
US8493267B2 (en) * | 2006-11-10 | 2013-07-23 | Qualcomm Incorporated | Method and apparatus for position determination with extended SPS orbit information |
CN101393260B (zh) * | 2008-11-06 | 2011-04-06 | 华南理工大学 | 一种无线传感器网络目标定位与跟踪方法 |
CN101458325B (zh) * | 2009-01-08 | 2011-07-20 | 华南理工大学 | 一种基于自适应预测的无线传感器网络目标跟踪方法 |
EP2330433A1 (en) * | 2009-09-30 | 2011-06-08 | Astrium Limited | Positioning system |
CN102087109A (zh) * | 2009-12-04 | 2011-06-08 | 财团法人资讯工业策进会 | 位置估测***、装置及其估测方法 |
CN101778399B (zh) * | 2010-01-18 | 2012-07-04 | 哈尔滨工业大学 | 基于fcm和最小二乘曲面拟合法的wlan室内优化ann定位方法 |
JP5709651B2 (ja) * | 2011-06-03 | 2015-04-30 | 三菱電機株式会社 | 追尾装置 |
CN104540221B (zh) * | 2015-01-15 | 2018-06-22 | 哈尔滨工业大学 | 基于半监督sde算法的wlan室内定位方法 |
CN105933858B (zh) * | 2016-03-14 | 2017-07-07 | 上海剑桥科技股份有限公司 | 无线定位装置 |
CN108132053B (zh) * | 2017-11-24 | 2020-01-07 | 北京工商大学 | 一种行人轨迹构建方法、***及惯性测量装置 |
US11378961B2 (en) * | 2018-04-17 | 2022-07-05 | Baidu Usa Llc | Method for generating prediction trajectories of obstacles for autonomous driving vehicles |
CN110113708B (zh) * | 2018-04-18 | 2020-12-01 | 爱动超越人工智能科技(北京)有限责任公司 | 基于Wi-Fi位置指纹的定位方法和装置 |
CN109195104A (zh) * | 2018-08-27 | 2019-01-11 | 上海市计量测试技术研究院 | 一种基于支持向量回归和卡尔曼滤波相结合的室内定位方法 |
CN109141427B (zh) * | 2018-08-29 | 2022-01-25 | 上海理工大学 | 在非视距环境下基于距离和角度概率模型的ekf定位方法 |
CN109375248A (zh) * | 2018-10-15 | 2019-02-22 | 北极星云空间技术股份有限公司 | 一种卡尔曼多模融合定位算法模型及其串行更新的方法 |
-
2020
- 2020-04-14 CN CN202010290207.2A patent/CN111537950B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN111537950A (zh) | 2020-08-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111862659B (zh) | 一种gps轨迹数据匹配和补全的方法 | |
CN110244715B (zh) | 一种基于超宽带技术的多移动机器人高精度协同跟踪方法 | |
CN103471589B (zh) | 一种室内行人行走模式识别和轨迹追踪的方法 | |
CN109633590B (zh) | 基于gp-vsmm-jpda的扩展目标跟踪方法 | |
CN109708638B (zh) | 一种船舶轨迹点提取方法 | |
JPWO2018008082A1 (ja) | 走行車線推定システム | |
CN108134640B (zh) | 一种基于节点运动状态约束的协作定位***和方法 | |
CN113470089B (zh) | 一种基于三维点云的跨域协同定位和建图方法及*** | |
CN111257865B (zh) | 一种基于线性伪量测模型的机动目标多帧检测跟踪方法 | |
CN112632202B (zh) | 一种基于高阶隐马尔可夫模型的动态地图匹配方法 | |
CN115265555B (zh) | 基于隐马尔科夫的多噪声感知的地图匹配校正方法及*** | |
CN114090718B (zh) | 基于Bi-LSTM预测与模糊分析的中断航迹关联方法 | |
CN110986965A (zh) | 基于隐马尔可夫模型的低频浮动车轨迹数据路网匹配方法 | |
CN104237862B (zh) | 基于ads‑b的概率假设密度滤波雷达***误差融合估计方法 | |
CN111537950B (zh) | 一种基于位置指纹和二步多项式拟合的卫星位置预测跟踪方法 | |
CN114236480A (zh) | 一种机载平台传感器***误差配准算法 | |
CN116430423B (zh) | 一种运动数据中卫星导航定位轨迹点坐标修正方法 | |
CN116975184A (zh) | 一种车辆轨迹数据处理方法、装置、设备和可读存储介质 | |
CN112052339A (zh) | 基于知识图谱的目标轨迹预测方法、***及存储介质 | |
CN113761662B (zh) | 一种滑翔类目标的轨迹预测管道的生成方法 | |
CN113158415B (zh) | 一种基于误差分析的车辆轨迹相似度评估方法 | |
CN112800889B (zh) | 一种基于分布式矩阵加权融合高斯滤波的目标跟踪方法 | |
CN105549003A (zh) | 一种汽车雷达目标跟踪方法 | |
CN111896002A (zh) | 地形辅助导航匹配区在线规划与适配性分析方法及*** | |
CN113759904A (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 |