CN101526602A - 基于预测滤波器的位置测量方法 - Google Patents

基于预测滤波器的位置测量方法 Download PDF

Info

Publication number
CN101526602A
CN101526602A CN200910118562A CN200910118562A CN101526602A CN 101526602 A CN101526602 A CN 101526602A CN 200910118562 A CN200910118562 A CN 200910118562A CN 200910118562 A CN200910118562 A CN 200910118562A CN 101526602 A CN101526602 A CN 101526602A
Authority
CN
China
Prior art keywords
mobile node
motion
location
measurement method
weight
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.)
Granted
Application number
CN200910118562A
Other languages
English (en)
Other versions
CN101526602B (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.)
Korea Advanced Institute of Science and Technology KAIST
Original Assignee
Samsung Electronics Co Ltd
Research and Industrial Cooperation Group
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 Samsung Electronics Co Ltd, Research and Industrial Cooperation Group filed Critical Samsung Electronics Co Ltd
Publication of CN101526602A publication Critical patent/CN101526602A/zh
Application granted granted Critical
Publication of CN101526602B publication Critical patent/CN101526602B/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
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-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/0294Trajectory determination or predictive filtering, e.g. target tracking or Kalman filtering
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W24/00Supervisory, monitoring or testing arrangements
    • H04W24/10Scheduling measurement reports ; Arrangements for measurement reports
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W64/00Locating users or terminals or network equipment for network management purposes, e.g. mobility management
    • H04W64/003Locating users or terminals or network equipment for network management purposes, e.g. mobility management locating network equipment
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W8/00Network data management
    • H04W8/02Processing of mobility data, e.g. registration information at HLR [Home Location Register] or VLR [Visitor Location Register]; Transfer of mobility data, e.g. between HLR, VLR or external networks

Abstract

本发明提供一种使用预测滤波器的、移动节点的位置测量方法,用于提高移动节点的位置测量的精确性。移动节点的位置测量方法检测所述移动节点的运动方式的变化,基于所述运动方式的变化来校正位置测量周期及预测滤波器的权重,以及使用所述位置测量周期及预测滤波器的校正后的权重来补偿所述移动节点的位置。

Description

基于预测滤波器的位置测量方法
技术领域
本发明一般涉及位置测量方法,更具体地,涉及使用预测滤波器的、移动节点的位置测量方法,该预测滤波器能够提高移动节点的位置测量精确性。
背景技术
在用于计算移动节点的位置测量误差的方法中,预测滤波器使用以往(past)测量信息和环境信息来预测移动节点的位置。
为了补偿移动节点的位置测量误差,使用基于利用以往测量和环境信息的补偿方法的预测滤波器,或利用先前(previously)记录的位点特异性(site-specific)信号模式的指纹(finger printing)方法。
预测滤波器允许利用以往位置和状态信息来估计移动节点的当前位置,以及通过采用取决于信息可靠性的权重来补偿测量的位置与预测的位置之间的偏差。卡尔曼(Kalman)滤波器是熟知的预测滤波器之一。卡尔曼滤波器调整应用到协方差矩阵的估计值和实际测量值的权重。
下面,简要地说明基于卡尔曼滤波器的位置预测方法。首先,移动节点获得至少三个锚点(anchor node)的坐标,并且周期性地测量与(from)锚点的距离,然后通过最小平方法(least square method)确定具有来自每个锚点的最小误差的坐标作为该移动节点的位置。将获得的坐标输入到卡尔曼滤波器,以便将输出作为补偿的坐标。以下参照图1、2A和2B更详细地说明该方法。
图1是说明使用传统最小平方法和卡尔曼滤波器的测量误差补偿的仿真结果的图形,而图2A和2B是说明在室内环境中移动节点的运动的示例的概念图。
图1中,X轴和Y轴代表以米(m)为单位的距离。测量周期(Δt)被设置为2秒,而移动节点以0.6m/s的速度运动。
实线110代表移动节点的运动路线,而标记x 130代表使用最小平方法估计的位置值,粗实线150代表使用卡尔曼滤波器补偿位置测量误差的移动节点的运动路线。
这里,假设卡尔曼滤波器(即,处理协方差矩阵)和测量协方差矩阵的权重是恒定。
RMSE(最小平方)是通过应用最小平方法而获得的均方根误差(RootMean Squared Error,RMSE)。也就是说,RMSE指示通过最小平方法计算的坐标与测量的坐标之间的平均误差量。RMSE(卡尔曼滤波器)是通过应用卡尔曼滤波器而获得的RMSE。也就是说,RMSE(卡尔曼滤波器)指示通过应用最小平方法和接着应用卡尔曼滤波器而获得的坐标与测量的坐标之间的平均误差的大小。
如图1中所示,当使用恒定协方差,并且移动节点的运动方向突然改变时,通过应用卡尔曼滤波器而获得的路径与实际的运动路径发生偏离。当先前笔直沿着走廊运动的移动节点的运动方向在走廊的拐角处改变它的运动方向时(参看图2A),或者当移动节点进入到位于走廊的一侧的房间时(参看图2B),会发生这种效果。
为了解决这个问题,已经将研究集中在适应于移动节点的情况来确定预测滤波器的权重的方法。结果,大部分传统技术已经被开发具有诸如加速度传感器和/或初始传感器(initia sensor)的补充设备,用于获取调整预测滤波器的权重所需的信息。
然而,由于诸如加速度传感器和初始传感器的额外的物理元件增加了移动节点的制造成本和大小,传统技术是不利的。另外,处理额外元件获得的信息增加了系统的复杂性。
发明内容
为了解决现有技术的上面的问题,本发明提供一种位置测量方法,该方法能够使用预测滤波器提高位置测量的精确性。
本发明还提供一种位置测量方法,该方法能够适应性地调整卡尔曼滤波器的参数,用于提高位置测量的精确性,特别是在室内环境中。
本发明还提供一种位置测量方法,该方法能够通过适应性地使用卡尔曼滤波器来提高位置测量的精确性。
本发明还提供一种用于移动节点的位置测量方法,该方法能够适应于移动节点的运动而改变位置测量周期(Δt)和预测滤波器的权重。
此外,本发明提供一种用于移动节点的位置测量方法,该方法通过预测移动节点的运动的变化,并适应性地校正在测量周期和误差补偿过程中使用的预测滤波器的权重,能够提高位置测量的精确性。
依照本发明的实施例,移动节点的位置测量方法包括:检测移动节点运动方式(pattern)的变化;根据运动方式的变化来校正位置测量周期和预测滤波器的权重;以及使用位置测量周期和预测滤波器的校正后的权重来计算移动节点的位置。
依照本发明的另一个实施例,移动节点的位置测量方法包括:当检测移动节点的运动方式的变化时,使用最小平方法估计移动节点的位置;将运动方式的距离和方位角与各自的阈值进行比较;当运动方式的距离大于阈值时,校正位置测量周期的权重,当运动方式的方位角大于阈值时,校正预测滤波器的权重;以及通过应用校正后的权重来计算移动节点的位置测量。
附图说明
通过以下以结合附图的详细描述,本发明的上述的和其他的目的、特征和优势将更加清楚,其中:
图1是说明使用传统的最小平方法和卡尔曼滤波器补偿位置测量误差的仿真结果的图形;
图2A和2B是说明在室内环境中移动节点的运动的概念图;
图3是说明在根据本发明实施例的位置测量方法中使用的位置测量周期(Δt)和位置变化测量周期(Δs)的概念的示图;
图4和图5是说明根据本发明实施例的位置测量及测量补偿方法的流程图;
图6是说明在根据本发明实施例的位置测量方法中位置测量的计算的示图;以及
图7是说明根据本发明实施例的位置测量方法的仿真结果的图形。
具体实施方式
参照附图详细地描述本发明的实施例。贯穿附图,相同的参考数字用于指代相同或相似的部分。省略对结合于此的熟知的功能和结构的详细描述,以避免其使本发明的实质内容模糊。
在说明书和权利要求书中所使用的词和术语仅是为了说明的目的而不是限制。其中所描述的示例和构造不覆盖本发明的全部技术精神,而仅是本发明的最优选实施例。因此,应当理解的是,可以对本发明的实施例做出各种等效替换和修改。
在下面的说明中,提供一种基于预测滤波器的位置测量方法,用于提高移动节点的位置测量的精准性。在下面的实施例中,移动节点适应性地调整预测滤波器的参数值,用于增加位置测量的精准性,特别是在室内环境中。也就是说,移动节点校正测量周期(Δt)和预测滤波器的权重以适应于移动节点的运动。
为此,根据实施例的移动节点辨识(recognize)运动方式的改变,并且校正测量周期(Δt)和预测滤波器的权重以适应于运动方式的改变,用于补偿移动节点的位置测量。
在根据本发明实施例的位置测量方法中,移动节点在每个测量周期将位移信息转换到柱面坐标,以便辨识运动的变化。
在根据本发明实施例的位置测量方法中,位置测量周期(Δt)被调整以便补偿由移动节点的运动而引发的误差。
在根据本发明实施例的位置测量方法中,位置测量周期(Δt)被与移动节点的运动速度成比反例地调整。
在根据本发明实施例的位置测量方法中,预测滤波器的权重根据移动节点的运动的变化来调整。
在根据本发明实施例的位置测量方法中,移动节点计算其运动方向和速度的变化,以及当计算的值大于阈值时,移动节点调整要在预测滤波器的估计值和测量值之间应用的权重。
在根据本发明实施例的位置测量方法中,当运动方向和速度的变化大于阈值时,移动节点增加要应用到测量值的权重,因此,在测量位置的补偿过程中,首先补偿测量值。
尽管根据本发明的实施例,在位置测量方法中采用卡尔曼滤波器作为预测滤波器,但本发明不被限制于此。例如,本发明的位置测量方法能够用多种的用于计算位置测量误差的预测滤波器来实现。
卡尔曼滤波器被称为最优递归数据处理算法。卡尔曼滤波器通过递归数据处理追踪最优值并且是有效用于使用最小平方法,依照具有运动比噪声的方程(equations of motion to noise)的时间,实时追踪基于时间的状态向量的递归计算方法。其中,最小平方法是用于获得估计量的方法,该估计量减少误差的平方和,即,最小平方估计器。
卡尔曼滤波器的使用描述如下。
首先,假设x(n)和y(n)满足等式组(1):
x(n+1)=F(n+1,n)x(n)+v1(n),(M×1矩阵)  (1)
y(n)=C(n)x(n)+v2(n),       (M×1矩阵)
v1(n)~N(0,Q1(n)),         (M×1矩阵)
v2(n)~N(0,Q2(n)),         (M×1矩阵)
在等式(1)中,忽略噪声。由于们的线性关系,变量会随着时间变化。另外,忽略变量和观察的值之间预期的噪声,其间存在线性关系。
在等式(1)中,x(n)是M×1矩阵,其包含预期为已知的、在特定时间n处的变量。如在第一个等式中所示的,忽略噪声v1(n),通过矩阵F(n+1,n),x(n)相对于x(n+1)线性地变化。限定x(n)与x(n+1)之间关系的F(n+1,n)是M×M矩阵,其被称为转换矩阵。如第三个等式中所示,v1(n)是噪声或观察误差且遵循具有均值0(M×1零矩阵)以及协方差矩阵Q1(n)(M×M矩阵)的正态分布(normal distribution)。y(n)是包含用于获取x(n)而观测的值的N×1矩阵。
如在第二个等式中所示的,忽略噪声v2(n),y(n)通过矩阵C(n)具有与x(n)的线性关系。限定y(n)与x(n)之间关系的C(n)是N×M矩阵,被称为测量矩阵。v2(n)可以被当作噪声或观察误差并遵循具有均值0(N×1零矩阵)和协方差矩阵Q1(n)(N×N矩阵)的正态分布。
利用上述系统模型,依照如下使用卡尔曼滤波器来估计x(n):
1)初始化
x(1|Y(0))=>x(1)最佳期望值(M×1矩阵)
K(1,0)=>用于最佳性能的恒定值(M×M矩阵)
F(n,n+1)=F(n+1,n)-1=>如果确定模型则预计算(M×M矩阵)
2)实际执行(n=1,2,...)
Figure A20091011856200081
(M×N矩阵)
α(n)=y(n)-C(n)×(n|Y(n-1)),(M×1矩阵)
x(n+1|Y(n))=F(n+1,n)×(n|Y(n-1))+G(n)α(n),(M×1矩阵)
K(n)=K(n,n-1)-F(n,n+1)G(n)C(n)K(n,n-1),  (M×M矩阵)
K(n+1,n)=F(n+1,n)K(n)FH(n+1,n)+Q1(n),    (M×M矩阵)
                                              (2)
其中,Y(n)是一组观察值{y(1),y(2),...,y(n)},x(n|Y(n-1)是基于对Y(n-1)的观察结果所估计的x(n),F(n,n+1)是F(n+1,n)的扩展概念,即F(n+1,n)的逆矩阵,用于在忽略噪声时从x(n+1)获得x(n),以及其他的参数是在中间计算过程中所使用的变量。上标H代表矩阵的共轭转置(conjugate transpose),以及上标-1代表矩阵的逆矩阵。
以下,定义在本发明的实施例中所使用的参数。
根据本发明的实施例,位置测量周期(Δt)是用于测量移动节点的位置的间隔。在每一测量周期(Δt),移动节点测量与至少三个锚点的距离并基于所述距离计算其的位置。
另外,根据本发明的实施例,位置变化测量周期(Δs)用于测量移动节点的运动变化。移动节点将以往变化测量周期的坐标与当前的变化测量周期的坐标进行比较,即,位置变化测量周期(Δs)是确定用于比较以往坐标与当前的坐标的持续时间的参数,并且是位置测量周期(Δt)的常数倍(constantmultiple)。
位置变化测量周期(Δs)被设置为位置测量周期(Δt)的常数倍,以便保证至少有一组坐标来自先前测量。
位置变化测量周期(Δs)是可变的。为了更精确地检测移动节点的运动,优选地将位置变化测量周期(Δs)设置为大值。不然,为了更快地检测移动节点的运动,优选地将位置变化测量周期(Δs)设置为小值。位置变化测量周期(Δs)太短时,难以确定角度的变化是由实际的运动引发的还是误差。因此,位置变化测量周期(Δs)应当被设置为针对最优化系统性能而获得的值。
参照附图,更详细地描述根据本发明的实施例的位置测量方法。
图3是说明在根据本发明的实施例的位置测量方法中使用的位置测量周期(Δt)和位置变化测量周期(Δs)的概念的示图。图3中示出具有预定误差范围的移动节点的最大误差角是根据位置变化测量周期(Δs)来确定的。
参考数字310代表移动节点的实际运动路径,参考数字320代表位置变化测量周期(Δs)以及参考数字330代表位置测量周期(Δt)。参考数字341、343、345和347代表随着移动节点沿路径310运动时移动节点的测量位置,而参考数字351、353、355和357代表到测量的位置341、343、345和347的移动节点的补偿的位置。
如下描述用于计算测量的位置测量周期以及预测滤波器的权重的调整。
移动节点在每个位置测量周期(Δt)获得来自至少三个锚点的测距结果(ranging result),并使用最小平方估计来计算移动节点的位置辨识坐标
Figure A20091011856200101
位置辨识坐标是测量的位置坐标。
从至少三个锚点获得测距结果的原因在于使用三角形算法来计算移动节点的位置。三角形算法利用来自锚点的信号的接收时间(time-of-arrivals)来计算移动节点与锚点之间的距离。将位置确定在用来自至少三个锚点的距离作为它们的直径而所画的圆周相交叉的点上。为此,移动节点接收来自至少三个锚点的测距结果。
接下来,移动节点将根据最小平方估计而获得的位置辨识坐标
Figure A20091011856200103
与在位置变化测量周期(Δs)之前所补偿的以往坐标进行比较,并将位移转换到柱面坐标系(σ,φ,z)的坐标。
柱面坐标系是三维的极坐标系,其中P点是由三元组(σ,φ,z)来表示的,除平面极坐标系外,包括与平面的高度z(或h)。柱面坐标系在分析关于轴对称的表面时是有效的。在柱面坐标系的情况下,点可以由多个坐标来表示。因此,概括来讲,参数的范围限制如下:
σ≥0,
0≤φ≤2π,以及(3)
z:无约束
在参数的范围中,如下将直角坐标系的坐标转换为柱面坐标系的坐标:
σ = x 2 + y 2 ,
φ = arctan y x , and - - - ( 4 )
z=z
根据本发明的一个实施例,坐标转换等式(4)可以由要应用于位置测量方法的等式(5)来表示。从最小平方估计获得的位置辨识坐标
Figure A20091011856200106
可如下转换到柱面坐标:
σ t = ( x ‾ t - x t - Δs ) 2 - ( y ‾ t - y t - Δs ) 2 以及
φ t = arctan { ( y ‾ t - y t - Δs ) ( x ‾ t - x t - Δs ) } - - - ( 5 )
将在时间t测量的位置辨识坐标与在位置变化测量周期(Δs)之前计算的以往位置测量进行比较,位置辨识坐标
Figure A20091011856200113
将依照等式(5)转换到柱面坐标。在柱面坐标系中,σt是移动节点的运动的距离,而φt是移动节点的运动的方位角(角度)。
接着,移动节点将在位置变化测量周期(Δs)期间的运动的距离σt和方位角φt与各自的阈值进行比较。
阈值被优选地设置为大于位置测量的误差范围。因此,在位置测量误差范围较窄的情况下,阈值被设置为更小的值,从而能更敏感地检测移动节点的运动方式。
作为测量值与阈值之间的比较结果,如果测量的距离大于阈值距离,则移动节点减少位置测量周期(Δt)。另外,如果测量的方位角大于阈值方位角,则移动节点在位置测量的计算中通过调整预测滤波器的权重来加权位置辨识坐标
Figure A20091011856200114
而不是估计的坐标。
另外,如果移动节点的运动的测量的距离和方位角小于阈值,则移动节点以传统方式使用预测滤波器来补偿测量。
以下,描述基于上述系统的位置测量方法。本发明不被限制于下面的描述,而在其他实施例中能够用等重等效替换和修改来实践。
图4和图5是说明根据本发明实施例的位置测量及测量补偿方法的流程图。
参照图4,根据本发明实施例的位置测量方法包括:在步骤401中,检测移动节点的运动方式的变化;在步骤403中,根据移动节点的运动方式的变化程度来校正位置测量周期(Δt)和预测滤波器的权重;以及,在步骤405中,基于校正后的位置测量周期(Δt)和预测滤波器的权重来计算移动节点的位置。
位置测量周期(Δt)是用于测量移动节点的位置的持续时间。参照图5更详细地描述了图4的步骤。
参照图4和图5,如果检测到运动方式的变化,则在步骤501中移动节点使用最小平方法估计它的位置。
为了辨识运动方式的变化,移动节点能够在每一位置变化测量周期(Δs)将位移信息转换到柱面坐标,该周期是可变的。移动节点的当前位置(即,位置辨识坐标
Figure A20091011856200121
)是通过将最小平方法应用到从至少三个锚点接收的测距结果来估计的。这里,位置辨识坐标
Figure A20091011856200122
是移动节点的测量的坐标。
接着,在步骤503,通过位置变化测量周期(Δs),移动节点将位置辨识坐标
Figure A20091011856200123
与移动节点的以往测量的坐标进行比较,并且,在步骤505,计算当前坐标与以往坐标之间的位移。然后,在步骤507,移动节点将该位移转换到柱面坐标。柱面坐标系是三维极坐标系,除平面极坐标系外,还包括与平面的高度z(或h)。坐标转换能够使用等式(3)至(5)来执行。
接着,在步骤509,通过位置变化测量周期(Δs),移动节点将其运动的距离和方位角分别与阈值距离和阈值方位角进行比较。
作为比较的结果,如果移动节点的运动的距离和方位角两者都大于阈值距离和阈值方位角,则移动节点在步骤511减少位置测量周期(Δt)并校正预测滤波器的权重,并在步骤513基于更新的位置测量周期(Δt)和预测滤波器的权重来补偿移动节点的位置。另外,在步骤513中,如果移动节点的运动的距离和方位角中的至少一个小于或等于阈值距离或阈值方位角,则移动节点以正常的补偿方式来补偿不大于对应阈值的目标(距离和/或方位角),而通过校正其权重来补偿大于对应阈值的目标(距离/方位角)。
图6是说明根据本发明的实施例的位置测量方法中位置测量的计算的示图。
参照图6,参考数字610、620、630和640代表通过位置变化测量周期(Δs)补偿的先前位置(t-4Δs,t-3Δs,t-2Δs和t-Δs),以及参考数字650代表在时间t测量的位置,即,移动节点的当前测量的位置。参考数字660代表位置610、620、630和640相较于在位置变化测量周期(Δs)之前的位置的位移,以及参考数字670代表当移动节点的运动方式突然变化时的位移。所示出的由节点的行进方向的变化所引发的方位角是较大的。
在图7中示出针对这样的示例情况执行的仿真结果。
图7是说明根据本发明的实施例的位置测量方法的仿真结果的图形。具体地说,图7示出了使用最小平方估计和卡尔曼滤波器的位置测量仿真结果,其中增加了在移动节点的运动变化较大的位置处所测量的值的权重(图6的670)。
如图7中所示,与图1中的传统方法的仿真结果相比较,根据本发明的实施例的使用位置测量方法所追踪的路径近似几乎与移动节点的实际路径相同,从而提高了位置测量的精确性。
位置700处的测量值已经通过采用校正后的协方差矩阵被计算,该矩阵担当卡尔曼滤波器的权重,且相比于图1的传统方法,已经减少了70%的RMSE(卡尔曼滤波器)。
模拟使用Matlap来执行。Matlap是提供数字分析和编程环境的工程软件,并且允许简单的矩阵运算、绘制函数及数据、执行算法、创建用户接口以及与其它语言的程序进行接口连接。
尽管在上面详细地描述了本发明的实施例,但应当清楚地知道,本领域技术人员所想到的、对这里所教导的基本发明构思的很多变化或修改仍在由所附权利要求书限定的本发明的精神和范围之内。
如上所述,使用根据本发明的预测滤波器的位置测量方法适应于移动节点的运动变化来调整在预测滤波器中所使用的权重和位置测量周期(Δt),因此提高了位置测量的精确性。
此外,本发明的位置测量方法使得预测滤波器的误差补偿性能相比于传统误差补偿方法提高了大约70%。另外,本发明的位置测量方法改进了移动节点的误差补偿性能,而没有在系统实施复杂性上妥协,因为位置测量方法可以在不增加任何额外设备的情况下执行。

Claims (14)

1、一种移动节点的位置测量方法,包括:
检测所述移动节点的运动方式的变化;
依照所述运动方式的变化来校正位置测量周期及预测滤波器的权重;
使用由校正后的权重更新的值来计算所述移动节点的当前位置。
2、如权利要求1所述的位置测量方法,其中,检测所述移动节点的运动方式的变化包括在位置变化测量周期期间将位移信息转换到柱面坐标,
并且,其中,所述位置变化测量周期是可变的。
3、如权利要求1所述的位置测量方法,其中,所述权重包括至少一个参数,该参数应用于位置测量周期和预测滤波器,用于计算由移动节点的运动方式的变化而引发的位置测量误差。
4、如权利要求3所述的位置测量方法,其中,所述位置测量周期与所述移动节点的运动速度成反比例。
5、如权利要求1所述的位置测量方法,其中,校正所述位置测量周期和所述预测滤波器的权重包括:
在每一位置测量周期,计算所述移动节点的运动方向和距离的位移;
将计算的位移与预定的阈值进行比较;以及
当所述位移大于预定的阈值中的各自的阈值时,调整要应用于所述预测滤波器的估计值的权重。
6、如权利要求5所述的位置测量方法,其中,校正所述位置测量周期和所述预测滤波器的权重包括:当所述位移小于或等于所述各自的阈值时,通过应用调整后的权重来计算位置测量误差。
7、一种移动节点的位置测量方法,包括:
当检测所述移动节点的运动方式的变化时,使用最小平方法估计所述移动节点的位置;
将所述运动方式的距离和方位角与各自的阈值进行比较;
当所述运动方式的距离大于所述阈值时,校正位置测量周期的权重;
当所述运动方式的方位角大于所述阈值时,校正预测滤波器的权重;以及
通过应用校正后的权重来计算所述移动节点的位置测量。
8、如权利要求7所述的位置测量方法,其中,估计所述位置包括:依照位置变化测量周期将位移信息转换到柱面坐标,以便检测所述移动节点的运动方式的变化,
以及,其中所述位置变化测量周期是可变的。
9、如权利要求7所述的位置测量方法,其中,将所述位移信息转换到柱面坐标包括:
计算估计位置与在所述位置变化测量周期之前的先前位置之间的位移;
将所述位移转换到柱面坐标;以及
从所述柱面坐标获得所述运动方式的距离和方位角。
10、如权利要求7所述的位置测量方法,其中,计算所述位置测量包括:
当所述运动方式的距离和方位角中的至少一个小于或等于所述各自的阈值时,使用所述预测滤波器计算所述距离和方位角中的至少一个;以及
当所述运动方式的距离和方位角中的至少一个大于所述各自的阈值时,校正所述距离和方位角中的至少一个的权重。
11、如权利要求9所述的位置测量方法,其中,所述距离和方位角是通过计算在时间(t)处测量的位置辨识坐标
Figure A2009101185620003C1
与在位置变化测量周期(Δs)之前测量并补偿的坐标之间的位移、以及使用以下公式将所述位移转换到柱面坐标而获得的:
σ t = ( x ‾ t - x t - Δs ) 2 - ( y ‾ t - y t - Δs ) 2
φ t = arctan { ( y ‾ t - y t - Δs ) ( x ‾ t - x t - Δs ) } ,
其中,σt是所述移动节点的运动的距离,而φt是所述移动节点的运动的方位角(角度)。
12、如权利要求11所述的位置测量方法,其中,位置辨识坐标
Figure A2009101185620003C4
是当前测量的移动节点的坐标,而所述位置变化测量周期(Δs)是用于测量移动节点的运动的变化的单位持续时间。
13、如权利要求7所述的位置测量方法,其中,所述阈值对应于所述移动节点的测量误差范围。
14、如权利要求7所述的位置测量方法,其中,所述预测滤波器是卡尔曼滤波器。
CN2009101185625A 2008-03-04 2009-03-04 基于预测滤波器的位置测量方法 Active CN101526602B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
KR1020080019931A KR101005753B1 (ko) 2008-03-04 2008-03-04 예보 필터를 이용한 측위 방법
KR19931/08 2008-03-04

Publications (2)

Publication Number Publication Date
CN101526602A true CN101526602A (zh) 2009-09-09
CN101526602B CN101526602B (zh) 2013-04-24

Family

ID=40821736

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2009101185625A Active CN101526602B (zh) 2008-03-04 2009-03-04 基于预测滤波器的位置测量方法

Country Status (4)

Country Link
US (1) US8374624B2 (zh)
EP (1) EP2098882A3 (zh)
KR (1) KR101005753B1 (zh)
CN (1) CN101526602B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104081844A (zh) * 2012-01-31 2014-10-01 高通股份有限公司 用于使用移动设备方位来定位移动设备的方法和装置
CN106954388A (zh) * 2014-08-22 2017-07-14 赫博·贝雯 传感器系统

Families Citing this family (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100978060B1 (ko) * 2009-12-08 2010-08-25 주식회사 케이티 실내 측위 시스템의 위치 보정 방법
US20110177809A1 (en) * 2010-01-15 2011-07-21 Qualcomm Incorporated Affecting a navigation function in response to a perceived transition from one environment to another
US8504077B2 (en) * 2010-12-04 2013-08-06 Wavemarket, Inc. System and method for monitoring and disseminating mobile device location information
KR101140045B1 (ko) * 2010-12-23 2012-05-02 연세대학교 산학협력단 사용자 위치 추적 방법 및 장치
US9295030B2 (en) 2011-12-02 2016-03-22 Qualcomm Incorporated Methods and apparatuses for improved paging area identifier selection in wireless networks containing low power base stations
US9113298B2 (en) 2012-06-12 2015-08-18 Telecommunication Systems, Inc. Geofence with kalman filter
GB201213172D0 (en) * 2012-07-24 2012-09-05 Sensewhere Ltd Method of estimating position of a device
KR20140052110A (ko) * 2012-10-11 2014-05-07 한국전자통신연구원 네트워크 최대 지연 추정 장치 및 방법, 네트워크 인입 제어 장치 및 방법
WO2014168635A1 (en) * 2013-04-12 2014-10-16 Hewlett-Packard Development Company, L.P. Determining an angle of direct path of a signal
WO2014168636A1 (en) 2013-04-12 2014-10-16 Hewlett-Packard Development Company, L.P. Location determination of a mobile device
US8768618B1 (en) * 2013-05-15 2014-07-01 Google Inc. Determining a location of a mobile device using a multi-modal kalman filter
KR102280610B1 (ko) * 2014-04-24 2021-07-23 삼성전자주식회사 전자 장치의 위치 추정 방법 및 장치
WO2015174764A1 (en) * 2014-05-15 2015-11-19 Samsung Electronics Co., Ltd. System for providing personalized information and method of providing the personalized information
KR102322027B1 (ko) * 2014-05-15 2021-11-08 삼성전자주식회사 개인화 정보 제공 시스템 및 그 방법
ES2762953T3 (es) 2014-05-15 2020-05-26 Samsung Electronics Co Ltd Sistema para proporcionar información personalizada y procedimiento para proporcionar la información personalizada
US10026226B1 (en) 2014-06-10 2018-07-17 Ripple Inc Rendering an augmented reality object
US9646418B1 (en) 2014-06-10 2017-05-09 Ripple Inc Biasing a rendering location of an augmented reality object
US10930038B2 (en) 2014-06-10 2021-02-23 Lab Of Misfits Ar, Inc. Dynamic location based digital element
US9619940B1 (en) * 2014-06-10 2017-04-11 Ripple Inc Spatial filtering trace location
US9993723B2 (en) * 2014-09-25 2018-06-12 Intel Corporation Techniques for low power monitoring of sports game play
WO2016131613A1 (en) 2015-02-18 2016-08-25 Sony Corporation Communications device, infrastructure equipment, mobile communications network and methods
KR20230084879A (ko) * 2021-12-06 2023-06-13 (주)뉴빌리티 다중 측위 방법 및 장치
CN115267667B (zh) * 2022-09-28 2023-04-07 长沙迪迈数码科技股份有限公司 井下高精度定位修正方法、装置、设备及存储介质

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5412011A (en) * 1977-06-30 1979-01-29 Nissan Motor Co Ltd Intake-air amount detecting apparatus for internal combustion engine
US6385454B1 (en) * 1998-10-09 2002-05-07 Microsoft Corporation Apparatus and method for management of resources in cellular networks
US6732050B2 (en) * 2001-05-23 2004-05-04 Nokia Mobile Phones Ltd Two-stage interacting multiple models filter for use in a global positioning system
US20040161474A1 (en) 2002-05-24 2004-08-19 Moerck Rudi E. Rare earth metal compounds methods of making, and methods of using the same
EP1602202A4 (en) 2003-03-13 2007-05-23 Meshnetworks Inc REAL-TIME SYSTEM AND METHOD FOR IMPROVING THE ACCURACY OF THE CALCULATED POSITION OF MOBILE PARTICIPANTS IN A WIRELESS AD-HOC NETWORK WITH A SLOW CENTRALIZED PROCESSING UNIT
US7312752B2 (en) * 2003-10-22 2007-12-25 Awarepoint Corporation Wireless position location and tracking system
US7158882B2 (en) * 2004-03-01 2007-01-02 Global Locate, Inc Method and apparatus for locating position of a mobile receiver
US7012564B2 (en) * 2004-08-05 2006-03-14 Global Locate, Inc. Method and apparatus for adjusting a measurement cycle in a satellite positioning system signal receiver
US7761233B2 (en) * 2006-06-30 2010-07-20 International Business Machines Corporation Apparatus and method for measuring the accurate position of moving objects in an indoor environment
CN100507600C (zh) * 2006-12-01 2009-07-01 清华大学 一种跟踪多移动目标的室内精确定位方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104081844A (zh) * 2012-01-31 2014-10-01 高通股份有限公司 用于使用移动设备方位来定位移动设备的方法和装置
CN106954388A (zh) * 2014-08-22 2017-07-14 赫博·贝雯 传感器系统

Also Published As

Publication number Publication date
US20090227266A1 (en) 2009-09-10
CN101526602B (zh) 2013-04-24
EP2098882A2 (en) 2009-09-09
KR20090094929A (ko) 2009-09-09
KR101005753B1 (ko) 2011-01-06
EP2098882A3 (en) 2010-05-05
US8374624B2 (en) 2013-02-12

Similar Documents

Publication Publication Date Title
CN101526602B (zh) 基于预测滤波器的位置测量方法
CN102519450B (zh) 一种用于水下滑翔器的组合导航装置及方法
CN101915580B (zh) 一种基于微惯性和地磁技术的自适应三维姿态定位方法
CN100470198C (zh) 步行者导航设备
CN105043388B (zh) 基于惯性/重力匹配组合导航的向量搜索迭代匹配方法
CN109413578A (zh) 一种基于wifi与pdr融合的室内定位方法
CN108319570B (zh) 一种异步多传感器空时偏差联合估计与补偿方法及装置
CN101105126B (zh) 基于微石英角速率传感器的随钻方位测量误差补偿方法
CN110553644B (zh) 一种矿用电铲精准定位系统和方法
CN111536967A (zh) 一种基于ekf的多传感器融合温室巡检机器人跟踪方法
CN110738275B (zh) 基于ut-phd的多传感器序贯融合跟踪方法
CN112798021B (zh) 基于激光多普勒测速仪的惯导系统行进间初始对准方法
KR20050025836A (ko) 관성 항법 시스템의 자세 보상 방법 및 장치, 이를 이용한관성 항법 시스템의 위치 계산 방법 및 장치
CN103369466A (zh) 一种地图匹配辅助室内定位方法
CN110231620A (zh) 一种噪声相关系统跟踪滤波方法
CN110657806A (zh) 一种基于CKF、chan解算和Savitzky-Golay平滑滤波的位置解算方法
CN110677140B (zh) 一种含未知输入和非高斯量测噪声的随机系统滤波器
KR101833007B1 (ko) 도플러 비컨을 이용한 수중 이동체의 위치 및 속도 추정 방법 및 시스템
CN110702093A (zh) 基于粒子滤波的定位方法、装置、存储介质及机器人
CN110243363B (zh) 一种基于低成本imu与rfid技术结合的agv实时定位方法
CN115540854A (zh) 一种基于uwb辅助的主动定位方法、设备和介质
CN115451946A (zh) 一种MEMS-IMU和Wi-Fi组合的室内行人定位方法
CN115809575A (zh) 一种工况传递路径分析方法
CN101598540A (zh) 三维定位方法和三维定位系统
CN105549003A (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
C41 Transfer of patent application or patent right or utility model
TA01 Transfer of patent application right

Effective date of registration: 20091127

Address after: Gyeonggi Do, South Korea

Applicant after: Samsung Electronics Co.,Ltd.

Co-applicant after: KOREA INSTITUTE OF SCIENCE AND TECHNOLOGY

Address before: Gyeonggi Do, South Korea

Applicant before: Samsung Electronics Co.,Ltd.

Co-applicant before: University Information & Communication of Icu Res and Industry Cooperation

C14 Grant of patent or utility model
GR01 Patent grant