CN110278525A - 一种高精度室内无线定位方法 - Google Patents
一种高精度室内无线定位方法 Download PDFInfo
- Publication number
- CN110278525A CN110278525A CN201910422092.5A CN201910422092A CN110278525A CN 110278525 A CN110278525 A CN 110278525A CN 201910422092 A CN201910422092 A CN 201910422092A CN 110278525 A CN110278525 A CN 110278525A
- Authority
- CN
- China
- Prior art keywords
- message
- node
- function
- kalman
- variable
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 51
- 239000011159 matrix material Substances 0.000 claims abstract description 26
- 239000013598 vector Substances 0.000 claims abstract description 20
- 238000009826 distribution Methods 0.000 claims abstract description 16
- 238000001914 filtration Methods 0.000 claims abstract description 4
- 238000013507 mapping Methods 0.000 claims description 27
- 238000004364 calculation method Methods 0.000 claims description 20
- 230000003044 adaptive effect Effects 0.000 claims description 11
- 238000005259 measurement Methods 0.000 claims description 10
- 238000012546 transfer Methods 0.000 claims description 7
- 230000005540 biological transmission Effects 0.000 claims description 6
- 239000013078 crystal Substances 0.000 claims description 4
- 238000005065 mining Methods 0.000 claims description 3
- 238000009827 uniform distribution Methods 0.000 claims description 3
- 238000004088 simulation Methods 0.000 description 8
- 238000005516 engineering process Methods 0.000 description 5
- 238000012360 testing method Methods 0.000 description 3
- 150000001875 compounds Chemical class 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000012216 screening Methods 0.000 description 1
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/14—Determining absolute distances from a plurality of spaced points of known location
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/023—Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/33—Services specially adapted for particular environments, situations or purposes for indoor environments, e.g. buildings
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W64/00—Locating users or terminals or network equipment for network management purposes, e.g. mobility management
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种高精度室内无线定位方法,包括以下步骤:A:在t时刻获得的所有N个锚节点到被测节点的距离及锚节点的坐标;B:通过卡尔曼滤波挖掘相邻时刻的空间相关性,定义在t时刻在x、y、z三个坐标上的卡尔曼状态方程系数,并将所有时刻的上述向量和矩阵归纳为指定集合形式;C:利用全概率公式和卡尔曼状态方程,对全局概率分布进行因子分解;D:利用步骤C中得到的因子分解进行建模,将因子图模型分为晶格网络部分、卡尔曼网络部分和卡尔曼参数估计部分;E:通过消息传递算法对晶格网络部分、卡尔曼网络部分和卡尔曼参数估计部分进行消息计算。本发明能够克高效准确的获得室内待测节点的高精度位置信息。
Description
技术领域
本发明涉及定位测量领域,尤其涉及一种高精度室内无线定位方法。
背景技术
随着无线通信和移动网络的发展,人们对定位的需求日益增加,但是由于信号遮挡等因素的存在,使得如北斗、GPS等通用的定位技术在室内环境下难以得到部署。
现有针对室内的无线定位技术主要有超宽带(UWB)、WiFi和Beacon定位技术等,每种技术均有特定的适用场景。上述技术的基本思路是通过计算“锚节点”(已知布置坐标的定位节点)的信号到达时间或接收功率,获得被测节点和锚节点的距离,然后通过三角定位法、质心算法或最小二乘估计算法确定被测节点的位置信息。
其中,三点定位法是利用不在同一条直线上的三个锚节点到未知节点的距离,通过解方程得到未知节点的坐标。质心算法是选出距离被测节点较近的多个锚节点,将其坐标依据到被测节点的距离进行加权平均。最小二乘估计算法则是将被测节点到多个锚节点的距离聚合成向量,将对应的锚节点坐标聚合成矩阵,通过求矩阵的伪逆得到待测节点的坐标估计。但是,上述三种方法均存在缺陷:
1、三点定位算法需要解方程组,但由于测量误差的存在,经常无法得到唯一解,需要进行近似,影响定位精度。
2、质心算法在锚节点数量很少的情况下定位精度较差。
3、最小二乘估计需要计算矩阵的伪逆,运算复杂度高,并且在矩阵不满秩的情况下无法求解。
4、在实际环境中待测物体具有通常处于连续的移动状态,此时刻的坐标通常与前一时刻的位置信息存在较大的相关性,而上述三种方法均未有效利用此相关性。
发明内容
本发明的目的是提供一种高精度室内无线定位方法,能够克服上述三种室内无线定位方法中的弊端,高效准确的获得室内待测节点的高精度位置信息。
本发明采用下述技术方案:
一种高精度室内无线定位方法,依次包括以下步骤:
A:设在t时刻被测节点可利用的锚节点个数为N,N≥3,根据每个锚节点的序列号得到对应的锚节点的坐标(xn,yn,zn),并随机将N个锚节点编号为[1:N];根据到达时间或接收功率得到被测节点在t时刻到第n个锚节点的距离1≤n ≤N;
B:设t时刻被测节点的真实坐标为(x(t),y(t),z(t)),并定义为向量形式α(t);
(x(t) y(t) z(t))T@α(t) (1);
将步骤A中在t时刻获得的所有N个锚节点到被测节点的距离及锚节点的坐标(xn,yn,zn),按(2)式计算并整理为向量r(t);
其中,为向量r(t)中第n个元素;
将t时刻获得的所有N个锚节点坐标,按(3)式计算并整理为矩阵Φ(t);
其中,为矩阵Φ(t)中第n行向量,为矩阵Φ(t)中第n行第1列元素;为矩阵Φ(t)中第n行第2列元素;为矩阵Φ(t)中第n行第3列元素;
由距离和坐标的运算关系
根据(1)式-(3)式,可得到
r(t)=Φ(t)α(t)+ω(t) (4);
其中,ω(t)表示实际测量过程中存在的误差向量;设误差服从均值为零、方差为σI的高斯分布,记为N(ω(t);0,σI),其中矩阵σI为大小为N×N的协方差矩阵;
通过卡尔曼滤波挖掘相邻时刻的空间相关性,将t时刻在x、y、z三个坐标上的卡尔曼状态方程系数定义为和并将所有t={1,...,T} 时刻的上述向量和矩阵归纳为如下集合形式,{α(1),...,α(T)}@α,{r(1),...,r(T)}@r, {Φ(1),...,Φ(T)}@Φ,
C:根据(4)式所示的运算关系,利用全概率公式、变量间的隐马尔科夫特性和卡尔曼状态方程,对全局概率分布P(r,α,Φ,A,B)进行因式分解:
(5)式中表达式P(g)表示概率分布;似然函数可分解为定义为函数 表示数学期望为方差为σI的高斯分布;由于连续的两次观测之间具有马尔可夫特性,表示为u为服从标准高斯分布的噪声,因此在(5) 式中:
坐标x(t),x(t-1)之间的函数约束为定义为函数
坐标y(t),y(t-1)之间的函数约束为定义为函数
坐标z(t),z(t-1)之间的函数约束为定义为函数
参数A和B的先验均假设为均匀分布,为P(A)=U(0,1),P(B)=U(0,1);其中U(a,b)表示区间为[a,b]的均匀分布;
D:利用步骤C中得到的因子分解进行因子图建模;
根据步骤C所示的因式分解进行因子图建模的过程为,定义(5)式中的每个函数为函数节点;定义每个变量为变量节点;将所有函数节点和与之相关的变量节点通过线段相连,便构成了因子图模型;
引入映射节点和对应的映射函数映射节点和对应的映射函数以及映射节点和对应的映射函数其中δ(g)表示delta函数;
将上述因子图模型分为晶格网络部分、卡尔曼网络部分和卡尔曼参数估计部分,其中晶格网络部分对应于函数节点到变量节点之间的网络,卡尔曼网络部分对应于函数节点到变量节点之间的网络,卡尔曼参数估计部分对应于变量节点之间互相连接的网络;
E:利用步骤D中所得的因子图模型,通过消息传递算法对晶格网络部分、卡尔曼网络部分和卡尔曼参数估计部分进行消息计算,得到在t时刻被测节点的高精度位置信息。
所述的步骤E包括以下具体步骤:
E1:通过消息传递算法对晶格网络部分进行消息计算;
根据消息传递算法中的平均场计算规则分别得到到的消息 到的消息以及到的消息
其中,变量和分别为坐标和的数学期望,其值可以由(14)式和(15)式得到,σ为测距噪声方差;
根据消息传递算法,变量到函数的消息计算为:
则映射函数到节点x(t)的消息为:
同理,映射函数到节点的消息计算为:
映射函数到节点的消息计算为:
E2:通过消息传递算法对卡尔曼网络部分进行消息计算;
设函数到变量x(t-1)的消息为其值在(12) 式中更新,则利用置信传播规则计算消息为
(10)式中变量和分别定义为
设卡尔曼状态方程系数的数学期望分别为和状态方程系数的计算方法分别在(19)式和(21)式中,则利用平均场规则计算得到中间函数进而利用置信传播规则计算消息为
其中,分别表示消息的期望和方差;由于定位算法不能根据t时刻的数据修正t-1时刻的位置估计,称之为无追溯性,则变量x(t)的置信与到x(t)的消息无关,即
其中,b(x(t))表示变量x(t)的后验概率估计,定义为置信;分别表示变量x(t)置信的期望和方差;
同理,得到坐标y、z的置信
在消息传递算法中,变量置信的物理意义为该变量的联合后验概率估计,即 (13)式—(15)式中得到了在t时刻被测节点的高精度位置信息;
E3:通过消息传递算法对卡尔曼参数估计部分进行消息计算;
根据t和t-1时刻坐标x的置信b(x(t))和b(x(t-1)),由平均场规则可以计算消息为
其中,表达式<f>b(x)表示以x为自变量对b(x)和f的乘积求积分;上式中变量和分别表示消息的期望和方差,可以计算为
假定连续Q个时刻状态方程系数不变,则可以得到自适应参数的置信
其中,自适应参数的期望和方差和分别为
利用期望最大化算法,将自适应参数的置信近似为
对于自适应参数的估计,假设中间变量则函数到的消息根据消息传递算法计算为
其中表达式<f>b(x)表示以x为自变量对b(x)和f的乘积求积分;上式中变量定义为
利用连续Q个时刻可以得到参数的估计值为从而得到变量的估计值
本发明能够克服上述三种室内无线定位方法中的弊端,有效提升测量精度,获得显著的性能增益,高效准确的获得室内待测节点的高精度位置信息。
附图说明
图1为本发明步骤A中被测节点随时间发生连续的位移的示意图;
图2为本发明实施例中锚节点部署位置和待测设备移动轨迹的俯视图;
图3为本发明实施例中锚节点部署位置和待测设备移动轨迹的三维视图;
图4为本发明实施例中效锚节点个数N=4时定位精度随噪声功率变化曲线图;
图5为本发明实施例中效锚节点个数N=6时定位精度随噪声功率变化曲线图;
图6为本发明实施例中效锚节点个数N=8时定位精度随噪声功率变化曲线图;
图7为本发明实施例中效锚节点个数N=12时定位精度随噪声功率变化曲线图;
图8为发明实施例中定位精度随有效锚节点个数变化曲线图。
具体实施方式
以下结合附图和实施例对本发明作以详细的描述:
如图1至图8所示,本发明所述的高精度室内无线定位方法,依次包括以下步骤:
A:设在t时刻被测节点可利用的锚节点个数为N,N≥3,根据每个锚节点的序列号得到对应的锚节点的坐标(xn,yn,zn),并随机将N个锚节点编号为[1:N];根据到达时间或接收功率得到被测节点在t时刻到第n个锚节点的距离1≤n ≤N;
实施过程如附图1所示,其中五角星代表固定位置的锚节点,圆形代表被测节点,假定被测节点随时间发生连续的位移,移动路线如曲线所示。
B:设t时刻被测节点的真实坐标为(x(t),y(t),z(t)),并定义为向量形式α(t);
(x(t) y(t) z(t))T@α(t) (1);
将步骤A中在t时刻获得的所有N个锚节点到被测节点的距离及锚节点的坐标(xn,yn,zn),按(2)式计算并整理为向量r(t);
其中,为向量r(t)中第n个元素;
将t时刻获得的所有N个锚节点坐标,按(3)式计算并整理为矩阵Φ(t);
其中,为矩阵Φ(t)中第n行向量,为矩阵Φ(t)中第n行第1列元素;为矩阵Φ(t)中第n行第2列元素;为矩阵Φ(t)中第n行第3列元素;
由距离和坐标的运算关系根据(1)式-(3)式,可得到
r(t)=Φ(t)α(t)+ω(t) (4);
其中,ω(t)表示实际测量过程中存在的误差向量;设误差服从均值为零、方差为σI的高斯分布,记为N(ω(t);0,σI),其中矩阵σI为大小为N×N的协方差矩阵;
通过卡尔曼滤波挖掘相邻时刻的空间相关性,将t时刻在x、y、z三个坐标上的卡尔曼状态方程系数定义为和并将所有t={1,...,T} 时刻的上述向量和矩阵归纳为如下集合形式,{α(1),...,α(T)}@α,{r(1),...,r(T)}@r, {Φ(1),...,Φ(T)}@Φ,
C:根据(4)式所示的运算关系,利用全概率公式、变量间的隐马尔科夫特性和卡尔曼状态方程,对全局概率分布P(r,α,Φ,A,B)进行因式分解:
(5)式中表达式P(g)表示概率分布;似然函数可分解为定义为函数 表示数学期望为方差为σI的高斯分布;由于连续的两次观测之间具有马尔可夫特性,表示为u为服从标准高斯分布的噪声,因此在(5) 式中:
坐标x(t),x(t-1)之间的函数约束为定义为函数
坐标y(t),y(t-1)之间的函数约束为定义为函数
坐标z(t),z(t-1)之间的函数约束为定义为函数
参数A和B的先验均假设为均匀分布,为P(A)=U(0,1),P(B)=U(0,1);其中U(a,b)表示区间为[a,b]的均匀分布;
D:利用步骤C中得到的因子分解进行因子图建模;
根据步骤C所示的因式分解进行因子图建模的过程为,定义(5)式中的每个函数为函数节点;定义每个变量为变量节点;将所有函数节点和与之相关的变量节点通过线段相连,便构成了因子图模型;
为了表达清楚,此处引入映射节点和对应的映射函数映射节点和对应的映射函数以及映射节点和对应的映射函数其中δ(g)表示delta函数;
将上述因子图模型分为晶格网络部分、卡尔曼网络部分和卡尔曼参数估计部分,其中晶格网络部分对应于函数节点到变量节点之间的网络,卡尔曼网络部分对应于函数节点到变量节点之间的网络,卡尔曼参数估计部分对应于变量节点之间互相连接的网络;
E:利用步骤D中所得的因子图模型,通过消息传递算法对晶格网络部分、卡尔曼网络部分和卡尔曼参数估计部分进行消息计算;
步骤E包括以下具体步骤:
E1:通过消息传递算法对晶格网络部分进行消息计算;
根据消息传递算法中的平均场计算规则分别得到到的消息、到的消息以及到的消息:
其中,变量和分别为坐标和的数学期望,其值可以由(14)式和(15)式得到,σ为测距噪声方差;
根据消息传递算法,变量到函数的消息计算为:
则映射函数到节点x(t)的消息为:
同理,映射函数到节点的消息为:
映射函数到节点的消息为:
E2:通过消息传递算法对卡尔曼网络部分进行消息计算;
设函数到变量x(t-1)的消息为其值在(12) 式中更新,则利用置信传播规则计算消息为
其中,变量和分别定义为
设状态方程系数的数学期望分别为和状态方程系数的计算方法分别在(19)式和(21)式中,则利用平均场规则计算得到中间函数进而利用置信传播规则计算消息为
其中分别表示消息的期望和方差。由于定位算法不能根据t时刻的数据修正t-1时刻的位置估计,称之为无追溯性,则变量x(t)的置信与到 x(t)的消息无关,即
其中,b(x(t))表示变量x(t)的后验概率估计,定义为置信;分别表示变量x(t)置信的期望和方差;
同理,可以得到坐标y、z的置信
在消息传递算法中,变量置信的物理意义为该变量的联合后验概率估计,即(13)式-(15)式中得到了在t时刻被测节点的高精度位置信息。
由于在所有时刻针对x,y,z坐标的消息计算具有完全相同的形式,简洁起见在步骤E2和步骤E3部分仅给出t时刻针对x坐标的消息更新公式,而对其他时刻和y,z坐标的更新可以类比得到,仅仅需要将对应的坐标x替换为y、z,时间t 替换为其他时刻即可。
E3:通过消息传递算法对卡尔曼参数估计部分进行消息计算;
由于本发明能自适应调整卡尔曼方法中状态方程系数,可以称之为自适应卡尔曼方法,其中系数和也称之为自适应系数。根据t和t-1时刻坐标x的置信b(x(t))和b(x(t-1)),由平均场规则可以计算消息为
其中表达式<f>b(x)表示以x为自变量对b(x)和f的乘积求积分。上式中变量和分别表示消息的期望和方差,可以计算为
假定连续Q个时刻状态方程系数不变,则可以得到自适应参数的置信
其中,自适应参数的期望和方差和分别为
利用期望最大化算法,将自适应参数的置信近似为
对于自适应参数的估计,假设中间变量则函数到的消息可以根据消息传递算法计算为
其中表达式<f>b(x)表示以x为自变量对b(x)和f的乘积求积分,上式中变量定义为
利用连续Q个时刻可以得到参数的估计值为从而得到变量的估计值
根据本发明提出的定位算法,可以建立仿真环境,对所提算法以及文献中已有算法进行对比。本实施例中建立仿真环境对本文所提算法以及文献中已有算法进行数值仿真和对比。仿真环境设定为一个高1m、长宽均为5m的空间,每间隔 1m部署一个锚节点(锚节点部署时存在一定的装配误差)。待测设备在x轴和y轴方向上线性移动,在z轴方向上以正弦方式周期移动,并且移动轨迹并非光滑,而是有一定的随机抖动,如附图2和附图3所示。在附图2和附图3中,锚节点的部署位置由星号表示,设备的移动轨迹由实线表示,其中附图2和附图3分别为对应的俯视图和三维视图。
假定待测设备在移动时检测到距离最近的N'个锚节点,但其中可能存在某个锚节点受到遮挡导致测距发生突变,经筛选后假设有效的锚节点个数为N=4:12。与本发明所提算法进行对比的算法有基础的三点质心算法、质心算法以及最小二乘估计方法。本文所提方法在估计自适应参数时设定连续Q=5次观测中状态方程具有相同系数。仿真中通过在真实距离上叠加高斯噪声模拟测量误差,噪声功率为-4dB至-16dB,定位精度由最小均方误差(MSE)表示,计算如下:
附图4至附图8给出了所有算法的定位精度随测量误差的变化曲线,其中附图4至附图7分别给出了接收机接收到锚节点个数N=4、6、8和12时的仿真结果,从中可以看出发明所提算法能够有效提升测量精度。附图8展示了测量精度随有效锚节点个数的变化曲线,从中可以看出在锚节点个数较少时,本发明所提算法并不能表现出明显的性能增益,而随观测到的锚节点个数增加,本发明所提算法定位精度迅速提升。总之,由仿真结果表明,相对于已知算法本发明提出的动态定位算法能够获得显著的性能增益,具有很高的实用价值。
Claims (2)
1.一种高精度室内无线定位方法,其特征在于,依次包括以下步骤:
A:设在t时刻被测节点可利用的锚节点个数为N,N≥3,根据每个锚节点的序列号得到对应的锚节点的坐标(xn,yn,zn),并随机将N个锚节点编号为[1:N];根据到达时间或接收功率得到被测节点在t时刻到第n个锚节点的距离1≤n≤N;
B:设t时刻被测节点的真实坐标为(x(t),y(t),z(t)),并定义为向量形式α(t);
(x(t) y(t) z(t))T@α(t) (1);
将步骤A中在t时刻获得的所有N个锚节点到被测节点的距离及锚节点的坐标(xn,yn,zn),按(2)式计算并整理为向量r(t);
其中,为向量r(t)中第n个元素;
将t时刻获得的所有N个锚节点坐标,按(3)式计算并整理为矩阵Φ(t);
其中,为矩阵Φ(t)中第n行向量,为矩阵Φ(t)中第n行第1列元素;为矩阵Φ(t)中第n行第2列元素;为矩阵Φ(t)中第n行第3列元素;
由距离和坐标的运算关系
根据(1)式-(3)式,得到
r(t)=Φ(t)α(t)+ω(t) (4);
其中,ω(t)表示实际测量过程中存在的误差向量;设误差服从均值为零、方差为σI的高斯分布,记为N(ω(t);0,σI),其中矩阵σI为大小为N×N的协方差矩阵;
通过卡尔曼滤波挖掘相邻时刻的空间相关性,将t时刻在x、y、z三个坐标上的卡尔曼状态方程系数定义为和并将所有t={1,...,T}时刻的上述向量和矩阵归纳为如下集合形式,{α(1),...,α(T)}@α,{r(1),...,r(T)}@r,{Φ(1),...,Φ(T)}@Φ,C:根据(4)式所示的运算关系,利用全概率公式、变量间的隐马尔科夫特性和卡尔曼状态方程,对全局概率分布P(r,α,Φ,A,B)进行因式分解:
(5)式中表达式P(g)表示概率分布;似然函数可分解为定义为函数 表示数学期望为方差为σI的高斯分布;由于连续的两次观测之间具有马尔可夫特性,表示为u为服从标准高斯分布的噪声,因此在(5)式中:
坐标x(t),x(t-1)之间的函数约束为定义为函数
坐标y(t),y(t-1)之间的函数约束为定义为函数
坐标z(t),z(t-1)之间的函数约束为定义为函数
参数A和B的先验均假设为均匀分布,为P(A)=U(0,1),P(B)=U(0,1);其中U(a,b)表示区间为[a,b]的均匀分布;
D:利用步骤C中得到的因子分解进行因子图建模;
根据步骤C所示的因式分解进行因子图建模的过程为,定义(5)式中的每个函数为函数节点;定义每个变量为变量节点;将所有函数节点和与之相关的变量节点通过线段相连,便构成了因子图模型;
引入映射节点和对应的映射函数映射节点和对应的映射函数以及映射节点和对应的映射函数其中δ(g)表示delta函数;
将上述因子图模型分为晶格网络部分、卡尔曼网络部分和卡尔曼参数估计部分,其中晶格网络部分对应于函数节点到变量节点之间的网络,卡尔曼网络部分对应于函数节点到变量节点 之间的网络,卡尔曼参数估计部分对应于变量节点 之间互相连接的网络;
E:利用步骤D中所得的因子图模型,通过消息传递算法对晶格网络部分、卡尔曼网络部分和卡尔曼参数估计部分进行消息计算,得到在t时刻被测节点的高精度位置信息。
2.根据权利要求1所述的高精度室内无线定位方法,其特征在于,所述的步骤E包括以下具体步骤:
E1:通过消息传递算法对晶格网络部分进行消息计算;
根据消息传递算法中的平均场计算规则分别得到到的消息、到的消息以及到的消息:
其中,变量和分别为坐标和的数学期望,其值可以由(14)式和(15)式得到,σ为测距噪声方差;
根据消息传递算法,变量到函数的消息计算为:
则映射函数到节点x(t)的消息为:
同理,映射函数到节点的消息为:
映射函数到节点的消息为:
E2:通过消息传递算法对卡尔曼网络部分进行消息计算;
设函数到变量x(t-1)的消息为其值在(12)式中更新,则利用置信传播规则计算消息为
其中,变量和分别定义为
设状态方程系数的数学期望分别为和状态方程系数 的计算方法分别在(19)式和(21)式中,则利用平均场规则计算得到中间函数进而利用置信传播规则计算消息为
其中,分别表示消息的期望和方差;由于定位算法不能根据t时刻的数据修正t-1时刻的位置估计,称之为无追溯性,则变量x(t)的置信与到x(t)的消息无关,即
其中,b(x(t))表示变量x(t)的后验概率估计,定义为置信;分别表示变量x(t)置信的期望和方差;
同理,可以得到坐标y、z的置信
在消息传递算法中,变量置信的物理意义为该变量的联合后验概率估计,即(13)式-(15)式中得到了在t时刻被测节点的高精度位置信息;
E3:通过消息传递算法对卡尔曼参数估计部分进行消息计算;
根据t和t-1时刻坐标x的置信b(x(t))和b(x(t-1)),由平均场规则计算消息为
其中,表达式<f>b(x)表示以x为自变量对b(x)和f的乘积求积分;变量和分别表示消息的期望和方差,计算为
假定连续Q个时刻状态方程系数不变,则可以得到自适应参数的置信
其中,自适应参数的期望和方差和分别为
利用期望最大化算法,将自适应参数的置信近似为
对于自适应参数的估计,假设中间变量则函数到的消息根据消息传递算法可以计算为
其中,表达式<f>b(x)表示以x为自变量对b(x)和f的乘积求积分;变量定义为
利用连续Q个时刻可以得到参数的估计值为从而得到变量的估计值
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910422092.5A CN110278525B (zh) | 2019-05-21 | 2019-05-21 | 一种高精度室内无线定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910422092.5A CN110278525B (zh) | 2019-05-21 | 2019-05-21 | 一种高精度室内无线定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110278525A true CN110278525A (zh) | 2019-09-24 |
CN110278525B CN110278525B (zh) | 2020-12-11 |
Family
ID=67959066
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910422092.5A Active CN110278525B (zh) | 2019-05-21 | 2019-05-21 | 一种高精度室内无线定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110278525B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111852456A (zh) * | 2020-07-29 | 2020-10-30 | 中国矿业大学 | 基于因子图的鲁棒uwb井下锚杆钻孔定位方法 |
CN112325885A (zh) * | 2020-10-30 | 2021-02-05 | 哈尔滨工业大学 | 一种基于数学统计特征的因子图协同定位算法 |
CN114061583A (zh) * | 2021-10-21 | 2022-02-18 | 郑州轻工业大学 | 基于自适应晶格卡尔曼滤波的移动机器人状态估计及自主导航方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101924986A (zh) * | 2009-06-10 | 2010-12-22 | 雷凌科技股份有限公司 | 用于无线通信系统的定位方法及其相关装置 |
CN103068041A (zh) * | 2012-12-31 | 2013-04-24 | 广州杰赛科技股份有限公司 | 一种定位方法 |
CN108037502A (zh) * | 2017-09-28 | 2018-05-15 | 南通大学 | 一种无人船水质检测作业路径的双雷达精准定位方法 |
CN108318856A (zh) * | 2018-02-02 | 2018-07-24 | 河南工学院 | 一种异构网络下快速精准的目标定位与跟踪方法 |
CN108347694A (zh) * | 2018-02-10 | 2018-07-31 | 北京理工大学 | 一种基于边界条件的节点定位方法及系统 |
CN109121080A (zh) * | 2018-08-31 | 2019-01-01 | 北京邮电大学 | 一种室内定位方法、装置、移动终端及存储介质 |
CN109379702A (zh) * | 2018-12-17 | 2019-02-22 | 北京理工大学 | 一种三维传感器网络节点定位方法及系统 |
WO2019083513A1 (en) * | 2017-10-24 | 2019-05-02 | Nissan North America, Inc. | LOCATION DETERMINATION FOR VEHICLE OPERATION |
-
2019
- 2019-05-21 CN CN201910422092.5A patent/CN110278525B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101924986A (zh) * | 2009-06-10 | 2010-12-22 | 雷凌科技股份有限公司 | 用于无线通信系统的定位方法及其相关装置 |
CN103068041A (zh) * | 2012-12-31 | 2013-04-24 | 广州杰赛科技股份有限公司 | 一种定位方法 |
CN108037502A (zh) * | 2017-09-28 | 2018-05-15 | 南通大学 | 一种无人船水质检测作业路径的双雷达精准定位方法 |
WO2019083513A1 (en) * | 2017-10-24 | 2019-05-02 | Nissan North America, Inc. | LOCATION DETERMINATION FOR VEHICLE OPERATION |
CN108318856A (zh) * | 2018-02-02 | 2018-07-24 | 河南工学院 | 一种异构网络下快速精准的目标定位与跟踪方法 |
CN108347694A (zh) * | 2018-02-10 | 2018-07-31 | 北京理工大学 | 一种基于边界条件的节点定位方法及系统 |
CN109121080A (zh) * | 2018-08-31 | 2019-01-01 | 北京邮电大学 | 一种室内定位方法、装置、移动终端及存储介质 |
CN109379702A (zh) * | 2018-12-17 | 2019-02-22 | 北京理工大学 | 一种三维传感器网络节点定位方法及系统 |
Non-Patent Citations (1)
Title |
---|
袁正道等: "基于混合消息传递和部分高斯近似的联合信道MIMO-OFDM接收机", 《信号处理》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111852456A (zh) * | 2020-07-29 | 2020-10-30 | 中国矿业大学 | 基于因子图的鲁棒uwb井下锚杆钻孔定位方法 |
CN112325885A (zh) * | 2020-10-30 | 2021-02-05 | 哈尔滨工业大学 | 一种基于数学统计特征的因子图协同定位算法 |
CN114061583A (zh) * | 2021-10-21 | 2022-02-18 | 郑州轻工业大学 | 基于自适应晶格卡尔曼滤波的移动机器人状态估计及自主导航方法 |
CN114061583B (zh) * | 2021-10-21 | 2023-07-07 | 郑州轻工业大学 | 基于自适应晶格卡尔曼滤波的移动机器人状态估计及自主导航方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110278525B (zh) | 2020-12-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109548141B (zh) | 基于卡尔曼滤波算法的室内环境基站坐标位置标定方法 | |
CN110278525B (zh) | 一种高精度室内无线定位方法 | |
US11448494B2 (en) | Device and method for generating geomagnetic sensor based location estimation model using artificial neural networks | |
CN108896047B (zh) | 分布式传感器网络协同融合与传感器位置修正方法 | |
CN107592671B (zh) | 一种网络化多智能体主动变拓扑的自主协同定位方法 | |
CN106093849B (zh) | 一种基于测距和神经网络算法的水下定位方法 | |
CN102231912A (zh) | 一种基于rssi测距的室内无线传感器网络定位方法 | |
WO2003102622A1 (en) | Probabilistic model for a positioning technique | |
CN109581281B (zh) | 基于到达时间差和到达频率差的移动目标定位方法 | |
CN104640204B (zh) | 一种非直达波环境下无线传感器网络节点定位方法 | |
CN105101090B (zh) | 一种环境监测无线传感网的节点定位方法 | |
CN104507164B (zh) | 一种基于rss和测距无偏估计的wsn节点定位方法 | |
Zain et al. | Distributed localization for wireless sensor networks using binary particle swarm optimization (BPSO) | |
Zaeemzadeh et al. | Robust target localization based on squared range iterative reweighted least squares | |
CN110636436A (zh) | 基于改进chan算法的三维uwb室内定位方法 | |
CN115494450B (zh) | 一种高精度的超宽带室内定位跟踪与控制方法及装置 | |
KR101081414B1 (ko) | 입자 군집 최적화를 이용한 무선측위 방법 | |
Fang et al. | Robust node position estimation algorithms for wireless sensor networks based on improved adaptive Kalman filters | |
CN104050686B (zh) | 一种密集空间目标跟踪方法 | |
CN113347709A (zh) | 一种基于uwb的室内定位方法及系统 | |
EP3844522B1 (en) | Methods for geolocation using electronic distance measurement equipment | |
Lou et al. | High-accuracy positioning algorithm based on UWB | |
CN103327608A (zh) | 一种稀疏化节点定位算法 | |
Mwila et al. | An efficient approach to node localisation and tracking in wireless sensor networks | |
Gazzah et al. | Selective Hybrid RSS/AOA Approximate Maximum Likelihood Mobile intra cell Localization. |
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 |