CN106226732A - 基于tof及迭代无迹滤波的室内无线定位跟踪方法 - Google Patents
基于tof及迭代无迹滤波的室内无线定位跟踪方法 Download PDFInfo
- Publication number
- CN106226732A CN106226732A CN201610533697.8A CN201610533697A CN106226732A CN 106226732 A CN106226732 A CN 106226732A CN 201610533697 A CN201610533697 A CN 201610533697A CN 106226732 A CN106226732 A CN 106226732A
- Authority
- CN
- China
- Prior art keywords
- moment
- calculate
- coordinate
- anchor node
- destination node
- 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
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/0294—Trajectory determination or predictive filtering, e.g. target tracking or Kalman filtering
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
本发明公开了一种基于TOF及迭代无迹滤波的室内无线定位跟踪方法,主要解决目前定位跟踪方法缺乏有效的误差控制及数据利用率不高的问题。其实现方案是:1.根据目标节点与锚节点之间的通信时间信息,利用对称双向双边测距算法计算目标节点与锚节点之间的距离;2.根据距离信息进行三角形内点测试,得到被保留的锚节点组合;3.设定距离阈值和权重阈值,根据被保留的锚节点组合及对应的距离信息,计算目标节点当前时刻的坐标;4.根据目标节点当前时刻的坐标和实际运动状态,利用迭代无迹滤波算法预测目标节点下一时刻的坐标。本发明提高了数据的利用率和定位跟踪精度,可用于物流管理、紧急救助、设备检测、灾害预防及医疗保健。
Description
技术领域
本发明属于无线通信技术领域,具体涉及室内无线定位及跟踪方法,可用于物流管理、紧急救助、设备检测、灾害预防及医疗保健。
背景技术
近年来,随着物联网IoT的飞速发展,室内定位,作为一种基于位置的服务LBS,在物流管理、紧急救助、设备检测、灾害预防、医疗保健、个性化信息传递等领域显示出了巨大的活力。全球卫星导航系统,例如美国的GPS和中国的北斗2号均能够在室外为人们提供良好的定位服务,但在室内却显得有些无能为力。这是由于建筑物的阻挡,使得信号传递到室内时衰减严重,加之室内环境复杂,障碍物众多,信号极易受到噪声干扰及产生多径效应,而导致的定位精度大大降低。因此,传统的卫星定位技术难以应用到室内环境。
目前室内无线定位跟踪技术种类繁多,依据定位过程中是否需要测距,室内无线定位技术可以分为无需测距的定位技术和基于测距的定位技术。相较于无需测距的定位技术,基于测距的定位技术有着节点密度低、定位精度高的优势,因此被广泛应用。目前基于测距的定位技术可分为以下五种:基于到达角度AOA测距的室内无线定位技术、基于到达时间TOA测距的室内无线定位技术、基于到达时间差TDOA测距的室内无线定位技术、基于接收信号强度RSSI测距的室内无线定位技术和基于飞行时间TOF测距的室内无线定位技术。其中:
基于AOA测距的室内无线定位技术,其需要特殊的硬件设备如天线阵列或有向天线等来支持,有天线阵列的节点的耗能、尺寸以及价格都要超过普通的传感节点,与无线传感器网络低成本和低能耗的特性相违背,所以实用性较差;
基于TOA测距的室内无线定位技术,其要求节点之间保持严格的时间同步,由于无线电的传输速度非常快,而传感节点之间的距离又较小,因此实现高精度计时同步是非常困难的,限制了该技术的实用性;
基于TDOA测距的室内无线定位技术,其虽不要求节点之间保持严格的时间同步,但是传输信号容易受环境因素影响产生多径效应及噪声干扰,因此系统难以适应复杂的室内环境;
基于RSSI测距的定位技术实现简单,其对硬件设备要求不高,成本低廉,是目前应用广泛的定位技术。但是该技术需要部署较多的锚节点,并且在障碍物较多的室内环境中,噪声干扰、多路径反射、非视线问题等因素导致节点获取的接收信号强度可能出现较大的随机波动,规律性较差,从而降低定位系统的准确性,使得定位系统难以满足高精度定位的需求;
基于TOF测距的室内无线定位技术,其需要额外的硬件设备支持,该技术使用双向通讯时间进行距离测量,有较精准的传输时间测量机制,因此相较以上四种测距技术有着较高的测距精度,但由于存在系统处理延迟及多径干扰,在近距离测量时会存在较大的测距误差,从而影响定位系统的精度。
福建师范大学在其专利申请号:201210010521.6,公开号:CN102573057A中公开了一种“一种优化的RFID室内定位方法”。该方法利用未知节点读取室内平均布置的锚节点的坐标信息,对读取到的坐标信息利用粒子滤波算法进行滤波,然后采用等边三角形的质心算法或权重质心算法来计算未知节点的坐标。这种方法由于对坐标信息进行粒子滤波,在坐标信息较少的情况下容易发生粒子贫化现象,并且由于对坐标信息没有合适的筛选机制,无法有效抑制异常数据引起的误差,导致系统定位误差较大。
上海机电学院在其专利申请号:201510916856.8,公开号:CN105491661A中提出了一种“基于改进的Kalman滤波算法的室内定位系统及方法”。该定位系统通过高斯滤波处理对各锚节点接收的RSSI值进行筛选并得到符合条件的值,由上位机计算出各RSSI值对应的距离,并将这些锚节点对应的距离值进行Kalman滤波处理,最后再经过三边定位及质心算法求出未知节点的坐标。这种方法通过滤波筛选了最优的三组数据进行定位计算,该方法由于在多锚节点下仅仅选取了三个锚节点的信息,因而没有充分利用其他锚节点的信息,使得数据利用率较低,定位结果可靠性不高。
发明内容
本发明的目的在于提供一种基于TOF及迭代无迹滤波的室内无线定位跟踪方法,以解决目前定位跟踪技术缺乏有效的误差控制及数据利用率不高的问题,提高室内定位跟踪的稳定性及定位精度。
本发明的技术方案是这样实现的:
本发明通过锚节点与目标节点之间相互通信获取时间信息,根据时间信息利用对称双向双边测距算法计算目标节点与锚节点间的距离,再根据距离变化信息进行三角形内点测试筛选所需要的锚节点组合,然后设定距离阈值和权重阈值对锚节点组合进行二次筛选,筛选后的锚节点组合利用三角质心加权法计算目标节点当前时刻的坐标,最后利用迭代无迹滤波算法预测目标节点的下一时刻的坐标,其实现步骤包括如下:
1)在k时刻和k+1时刻分别获取目标节点与锚节点Ai之间的通信时间信息,根据该时间信息利用对称双向双边测距方法分别计算k时刻和k+1时刻目标节点与锚节点Ai之间的距离Di(k)和Di(k+1);
2)任意选择三个不同坐标的锚节点作为一组进行三角形内点测试;根据k时刻和k+1时刻目标节点与锚节点的距离信息Di(k)、Di(k+1),舍弃Di(k)均小于Di(k+1)或者Di(k)均大于Di(k+1)的锚节点组合,直到遍历完所有组合,保留未被舍弃的锚节点组合;
3)根据2)中被保留的锚节点组合及k时刻对应的距离信息Di(k),计算出k时刻目标节点的坐标(x(k),y(k)):
3.1)根据锚节点数及实际部署情况设定距离阈值p和权重阈值q;
3.2)将2)中被保留的每个锚节点组合中最小的距离值设为di(k),若di(k)≥p,保留对应的锚节点组合;否则,舍弃该组合;
3.3)计算3.2)中被保留的锚节点组合的权重值hi,若hi≥q,保留对应的锚节点组合;否则,舍弃该组合;
3.4)对3.3)中保留的锚节点组合利用三角质心加权法计算出k时刻目标节点的坐标(x(k),y(k));
4)根据3)得到的坐标(x(k),y(k))及目标节点的实际运动状态,利用迭代无迹滤波方法预测出目标节点k+1时刻的坐标(x(k+1),y(k+1))。
本发明与现有技术相比,具有如下优点:
第一,由于本发明在定位计算前对距离信息进行了筛选,通过设定距离阈值和权重阈值舍弃精度较差的距离信息,克服了现有技术中未对距离信息进行合理筛选,导致距离信息在定位计算过程中容易引起较大误差,造成定位结果可靠性较低的不足,提高了定位跟踪的精度。
第二,由于本发明在处理定位坐标数据时使用了迭代无迹滤波算法,通过迭代计算加快了坐标数据的收敛,克服了现有滤波算法适应性差、易发散,无法有效抑制异常数据引起的误差的不足,提高了定位跟踪的稳定性。
附图说明
图1是本发明的总流程图;
图2是本发明中对锚节点组合进行三角形内点测试的子流程图;
图3是本发明中计算k时刻目标节点坐标的子流程图;
图4是本发明中预测目标节点k+1时刻的坐标的子流程图;
图5是用本发明和现有三种定位方法对目标节点定位的平均误差仿真图;
图6是用本发明和现有三种定位方法对目标节点定位的误差累计分布仿真图;
图7是用本发明和现有三种跟踪方法在单目标节点跟踪时的跟踪误差累计分布仿真图。
具体实施方式
下面结合附图及具体实施例对本发明中的方法进行详细完整的描述。本实施例以本发明的方法为前提进行实施,给出了详细的实施方式和具体操作过程,但本发明的保护范围不限于下述实施例,本领域普通技术人员在没有做出创造性前提下所获得的所有其他实施例,都属于本发明保护的范围。
参照图1,本实施例提供的基于TOF及迭代无迹滤波的室内无线定位跟踪方法包括以下步骤:
步骤1,获取目标节点与锚节点Ai之间的通信时间信息,根据该时间信息利用对称双向双边测距方法分别计算k时刻和k+1时刻目标节点与锚节点Ai之间的距离Di(k)和Di(k+1)。
本步骤的具体实现如下:
1.1)目标节点与通信范围内的锚节点Ai建立通信,其中锚节点坐标为Ai(xi,yi),i=1,2…,n,n≥3;
1.2)k时刻目标节点接收到的n组时间信息为:
其中表示k时刻目标节点的传播延迟,表示k时刻锚节点Ai的处理延迟,表示k时刻锚节点Ai的传播延迟,表示k时刻目标节点的处理延迟;
1.3)根据1.2)接收的n组时间信息计算k时刻目标节点与每个锚节点Ai之间的距离Di(k):
其中,C表示光速3×108m/s;
1.4)k+1时刻目标节点接收的n组时间信息为
其中表示k+1时刻目标节点的传播延迟,表示k+1时刻锚节点Ai的处理延迟,表示k+1时刻锚节点Ai的传播延迟,表示k+1时刻目标节点的处理延迟;
1.5)根据1.4)接收的n组时间信息计算k+1时刻目标节点与每个锚节点Ai之间的距离Di(k+1):
其中,C表示光速3×108m/s;
步骤2,任意选择三个不同坐标的锚节点作为一组进行三角形内点测试,获得被保留的锚节点组合。
参照图2,本步骤的具体实现如下:
2.1)任意选择三个不同坐标的锚节点Ai(xi,yi),Aj(xj,yj),Ak(xk,yk)作为一个组合,本实施例中部署了9个锚节点,因此有84种组合;
2.2)记录k时刻2.1)选择的三个锚节点Ai(xi,yi),Aj(xj,yj),Ak(xk,yk)对应的距离信息Di(k),Dj(k),Dk(k)以及k+1时刻对应的距离信息Di(k+1),Dj(k+1),Dk(k+1);
2.3)将2.2)中k时刻的距离信息与k+1时刻的距离信息进行比较:
如果Di(k)>Di(k+1),Dj(k)>Dj(k+1),Dk(k)>Dk(k+1)同时成立或者Di(k)<Di(k+1),Dj(k)<Dj(k+1),Dk(k)<Dk(k+1)同时成立,则舍去当前所选择的锚节点组合,并返回2.1);
否则,保留当前的锚节点组合;
2.4)重复2.1)到2.3),直到遍历完所有组合,得到被保留的锚节点组合。
步骤3,根据被保留的锚节点组合及对应k时刻的距离信息Di(k),计算k时刻的目标节点坐标(x(k),y(k))。
参照图3,本步骤的具体实现如下:
3.1)根据锚节点数及实际部署情况设置距离阈值p和权重阈值q,本实施例中,p=1.5,q=0.3;
3.2)在步骤2保留的锚节点组合中,每个组合取出k时刻3个距离值中最小的距离值,假设k时刻每个组合中最小的距离值分别为di(k),i=0,1,2,…,比较di(k)与p的大小:
若di(k)≥p,则继续保留该锚节点组合;
否则,舍弃该锚节点组合;
3.3)计算3.2)中被保留的锚节点组合的权重值hi;
3.3a)设锚节点组合中三个锚节点的坐标分别为A1(x1,y1),A2(x2,y2),A3(x3,y3),以这三个锚节点为顶点组成三角形ΔA1A2A3,计算∠A1,∠A2,∠A3分别对应的斜率K1,K2,K3:
K1=(y2-y3)/(x2-x3)
K2=(y3-y1)/(x3-x1)
K3=(y2-y1)/(x2-x1);
3.3b)根据上述的三个斜率K1,K2,K3,计算三角形ΔA1A2A3三个角的正切值:
tan A1=(K2-K3)/(1+K2K3)
tan A2=(K1-K3)/(1+K1K3)
tan A3=(K2-K1)/(1+K2K1);
3.3c)在三个正切值tan A1,tan A2,tan A3中,将最小且非负的正切值作为锚节点组合A1,A2,A3的权重值h;
3.3d)根据3.3a)到3.3c)的计算方法,分别计算出3.2)中被保留的所有的锚节点组合的权重值hi,i=0,1,2,…。
3.4)将3.3)中得到的权重值hi与权重阈值q进行比较:
若hi≥q,则继续保留该权重值hi对应的锚节点组合;
否则,舍弃该权重值hi对应的锚节点组合;
3.5)对3.4)中被保留的锚节点组合利用三角质心加权法计算出k时刻目标节点的坐标(x(k),y(k)):
3.5a)设锚节点组合中三个锚节点的坐标分别为A1(x1,y1),A2(x2,y2),A3(x3,y3),对应的距离分别为D1(k),D2(k),D3(k),建立如下方程:
3.5b)求解方程组<1>、<2>、<3>,得到3个点(x12,y12),(x23,y23),(x13,y13);
3.5b1)求解方程组<1>和<2>,得到两个解,记为(x12,y12),(x′12,y′12),选择这两个解中距离(x3,y3)最近的点,假设选择的点为(x12,y12);
3.5b2)求解方程组<2>和<3>,得到两个解,记为(x23,y23),(x′23,y′23),选择这两个解中距离(x1,y1)最近的点,假设选择的点为(x23,y23);
3.5b3)求解方程组<1>和<3>,得到两个解,记为(x13,y13),(x′13,y′13),选择这两个解中距离(x2,y2)最近的点,假设选择的点为(x13,y13);
3.5c)利用3.5b)得到的3个点,计算出目标节点的参考坐标
3.5d)根据3.5a)到3.5c)的计算方法,计算3.4)中被保留的所有的锚节点组合所对应的目标节点的参考坐标
3.5e)利用3.5d)得到的参考坐标计算出k时刻目标节点的坐标(x(k),y(k)):
步骤4,预测k+1时刻的目标节点坐标(x(k+1),y(k+1))。
参照图4,本步骤的具体实现如下:
4.1)根据步骤3得到的k时刻目标节点的坐标(x(k),y(k))以及目标节点的实际运动状态,计算k+1时刻的状态估计量及对应的协方差矩阵P(k+1):
4.1a)计算估计状态变量及对应的方差矩阵P(k):
其中,状态变量x(k),y(k)分别为k时刻目标节点的横坐标和纵坐标,由步骤3计算得到;分别为k时刻目标节点的横向速度和纵向速度,分别为k时刻目标节点的横向加速度和纵向加速度;W(k)是一个均值为0,方差为Q的高斯白噪声;本实施例中,
4.1b)对状态变量X(k)进行无迹变换,获取采样点集X(i)(k)及对应权值w(i):
其中,y表示展开维数,y的取值越大则计算精度越高,α为分布状态因子,α的取值决定了采样点集X(i)(k)的分布状态;η为待选参数,用以确保矩阵(y+λ)P(k)为半正定矩阵,λ=α2(y+η)-y;β为非负待选参数,用于表征状态变量高阶项的影响;在本实施例中,y=6,α=0.01,η=0,β=2;
4.1c)计算每个采样点X(i)(k)的一步预测X(i)(k+1|k):
X(i)(k+1|k)=F·X(i)(k)+G·W(k),i=0~2y
其中,F表示状态转移矩阵,G表示过程噪声矩阵,F、G的取值分别如下:
本实施例中,采样时间ts=1s;
4.1d)计算状态变量X(k)的一步预测及对应的协方差矩阵P(k+1|k):
4.1e)对一步预测进行无迹变换,获取新的采样点集X(i)(k+1|k):
4.1f)计算每个采样点X(i)(k+1|k)预测的观测量Z(i)(k+1|k):
其中x(i)(k+1|k),y(i)(k+1|k)表示4.1e)中X(i)(k+1|k)的横坐标和纵坐标,V(k)是一个均值为0,方差为R的高斯白噪声,R的取值根据实际环境设定,本实施例中,R=2;
4.1g)计算系统预测的观测量及对应的协方差矩阵和互协方差矩阵
4.1h)根据观测量的协方差矩阵和互协方差矩阵计算卡尔曼滤波增益K(k+1):
4.1i)计算k+1时刻状态估计量及对应的协方差矩阵P(k+1):
其中KT(k+1)为卡尔曼滤波增益K(k+1)的转置矩阵;
4.2)根据4.1)得到的状态估计量及协方差矩阵P(k+1),计算k+1时刻的迭代状态估计量及相应的协方差矩阵P(k+1)b;
4.2a)令P(k+1)0=P(k+1|k),P(k+1)1=P(k+1);令b=2,b表示迭代次数;
4.2b)利用无迹变换获取采样点集X(i)(k+1)b:
其中
4.2c)计算迭代一步预测估计
4.2d)计算每个迭代采样点预测的迭代观测量Z(i)(k+1|k)b:
其中x(i)(k+1|k)b,y(i)(k+1|k)b表示4.2b)X(i)(k+1|k)b中对应的横坐标和纵坐标;
4.2e)计算系统预测的迭代观测量及对应的协方差矩阵和互协方差矩阵
4.2f)根据迭代观测量的协方差矩阵和互协方差矩阵计算迭代卡尔曼滤波增益K(k+1)b:
4.2g)计算k+1时刻迭代状态估计量及对应的协方差矩阵P(k+1)b:
其中调整系数s=1;
4.2h)令并判断下式是否成立:
若成立且b≤N,则令b=b+1,s=s·γ,返回步骤4.2b),其中N为最大迭代次数,需根据具体环境设定,γ为衰减因子,取值范围为0~1,本实施例中,N=5,γ=0.8;
否则,将和P(k+1)b作为结果输出;
4.3)令P(k+1)=P(k+1)b,并从状态变量估计中得到k+1时刻目标节点的坐标(x(k+1),y(k+1))。
结合以下的仿真对本发明的应用效果作进一步的说明:
一、仿真条件:在10m*10m视距可达的空间内,随机分布100个目标,并在空间边缘均匀部署n个锚节点。
二、仿真内容与结果:
仿真1,用本发明与基于循环三边算法的室内无线定位方法、基于最大似然估计算法的室内无线定位方法以及基于三角质心算法的室内无线定位方法对目标节点定位的平均误差进行仿真,结果如图5所示。
由图5可见,在相同锚节点数的情况下,本发明与基于循环三边算法的室内无线定位方法、基于最大似然估计算法的室内无线定位方法以及基于三角质心算法的室内无线定位方法相比,平均定位误差最小,并且随着锚节点数的增加,本发明的定位精度也逐渐提高。
仿真2,当锚节点数n=5时,用本发明与基于循环三边算法的室内无线定位方法、基于最大似然估计算法的室内无线定位方法以及基于三角质心算法的室内无线定位方法对目标节点定位的误差累计分布进行仿真,结果如图6所示。
由图6可见,当定位精度为0.5米时,本发明与基于循环三边算法的室内无线定位方法、基于三角质心算法的室内无线定位方法以及基于最大似然估计算法的室内无线定位方法的概率分别为80.7%、78.9%、76.7%和68%;当定位精度为0.8米时,本发明与基于循环三边算法的室内无线定位方法、基于三角质心算法的室内无线定位方法以及基于最大似然估计算法的室内无线定位方法的概率分别为98.2%、96.3%、95.7%和94.4%;因而相较于这三种定位方法,本发明的定位精度更高,稳定性能更好。
仿真3,用本发明与基于卡尔曼滤波的室内无线定位方法KF、基于扩展卡尔曼滤波的室内无线定位方法EKF以及基于无迹卡尔曼滤波的室内无线定位方法UKF对单目标节点跟踪的误差累计分布进行仿真,结果如图7所示。
由图7可见,当跟踪精度为0.5m时,本发明与所述的基于卡尔曼滤波的室内无线定位跟踪方法KF、基于扩展卡尔曼滤波的室内无线定位跟踪方法EKF、以及基于无迹卡尔曼滤波的室内无线定位跟踪方法UKF的概率分别为82.7%、32.2%、60.7%和64.2%;因而相较于这三种跟踪滤波方法,本发明的跟踪精度更高,跟踪性能更好。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (6)
1.基于TOF及迭代无迹滤波的室内无线定位跟踪方法,包括:
1)在k时刻和k+1时刻分别获取目标节点与锚节点Ai之间的通信时间信息,根据该时间信息利用对称双向双边测距方法分别计算k时刻和k+1时刻目标节点与锚节点Ai之间的距离Di(k)和Di(k+1);
2)任意选择三个不同坐标的锚节点作为一组进行三角形内点测试;根据k时刻和k+1时刻目标节点与锚节点的距离信息Di(k)、Di(k+1),舍弃Di(k)均小于Di(k+1)或者Di(k)均大于Di(k+1)的锚节点组合,直到遍历完所有组合,保留未被舍弃的锚节点组合;
3)根据2)中被保留的锚节点组合及k时刻对应的距离信息Di(k),计算出k时刻目标节点的坐标(x(k),y(k)):
3.1)根据锚节点数及实际部署情况设定距离阈值p和权重阈值q;
3.2)将2)中被保留的每个锚节点组合中最小的距离值设为di(k),若di(k)≥p,保留对应的锚节点组合;否则,舍弃该组合;
3.3)计算3.2)中被保留的锚节点组合的权重值hi,若hi≥q,保留对应的锚节点组合;否则,舍弃该组合;
3.4)对3.3)中保留的锚节点组合利用三角质心加权法计算出k时刻目标节点的坐标(x(k),y(k));
4)根据3)得到的坐标(x(k),y(k))及目标节点的实际运动状态,利用迭代无迹滤波方法预测出目标节点k+1时刻的坐标(x(k+1),y(k+1))。
2.根据权利要求1所述的方法,步骤3.3)中计算锚节点组合的权重值hi,按如下步骤进行:
3.3a)设锚节点组合中三个锚节点的坐标分别为A1(x1,y1),A2(x2,y2),A3(x3,y3),以这三个锚节点为顶点组成三角形ΔA1A2A3,计算∠A1,∠A2,∠A3分别对应的斜率K1,K2,K3:
K1=(y2-y3)/(x2-x3)
K2=(y3-y1)/(x3-x1)
K3=(y2-y1)/(x2-x1)
3.3b)根据斜率K1,K2,K3,计算三角形ΔA1A2A3三个角的正切值:
tanA1=(K2-K3)/(1+K2K3)
tanA2=(K1-K3)/(1+K1K3)
tanA3=(K2-K1)/(1+K2K1)
3.3c)在三个正切值tanA1,tanA2,tanA3中,将最小且非负的正切值作为锚节点组合A1,A2,A3的权重值h;
3.3d)根据3.3a)到3.3c)的计算方法,分别计算出3.2)中被保留的所有的锚节点组合的权重值hi,i=0,1,2,…。
3.根据权利要求1所述的方法,步骤3.4)中利用三角质心加权法计算出k时刻目标节点的坐标(x(k),y(k)),按如下步骤进行:
3.4a)设锚节点组合中三个锚节点的坐标分别为A1(x1,y1),A2(x2,y2),A3(x3,y3),对应的距离分别为D1(k),D2(k),D3(k),建立如下方程:
3.4b)求解方程组<1>、<2>、<3>,得到3个点(x12,y12),(x23,y23),(x13,y13);
3.4b1)求解方程组<1>和<2>,得到两个解,记为(x12,y12),(x′12,y′12),选择这两个解中距离(x3,y3)最近的点,假设选择的点为(x12,y12);
3.4b2)求解方程组<2>和<3>,得到两个解,记为(x23,y23),(x′23,y′23),选择这两个解中距离(x1,y1)最近的点,假设选择的点为(x23,y23);
3.4b3)求解方程组<1>和<3>,得到两个解,记为(x13,y13),(x′13,y′13),选择这两个解中距离(x2,y2)最近的点,假设选择的点为(x13,y13);
3.4c)利用3.4b)得到的3个点,计算出目标节点的参考坐标
3.4d)根据3.4a)到3.4c)的计算方法,计算3.3)中被保留的所有的锚节点组合所对应的目标节点的参考坐标
3.4e)利用3.4d)得到的参考坐标计算出k时刻目标节点的坐标(x(k),y(k)):
4.根据权利要求1所述的方法,其中步骤4)中计算目标节点k+1时刻的坐标(x(k+1),y(k+1)),按如下步骤进行:
4.1)根据步骤3得到的坐标(x(k),y(k))以及目标节点的实际运动状态,计算k+1时刻的状态估计量及对应的协方差矩阵P(k+1);
4.2)根据4.1)得到的状态估计量及协方差矩阵P(k+1),计算k+1时刻的迭代状态估计量及对应的协方差矩阵P(k+1)b;
4.3)令P(k+1)=P(k+1)b,并从状态变量估计中得到k+1时刻目标节点的坐标(x(k+1),y(k+1))。
5.根据权利要求4所述的方法,其中步骤4.1)中计算k+1时刻的状态估计量及对应的协方差矩阵P(k+1),按如下步骤进行:
4.1a)计算状态估计变量及对应的方差矩阵P(k):
其中,状态变量x(k),y(k)分别为k时刻目标节点的横坐标和纵坐标,分别为k时刻目标节点的横向速度和纵向速度,分别为k时刻目标节点的横向加速度和纵向加速度,W(k)是一个均值为0,方差为Q的高斯白噪声;
4.1b)对状态变量X(k)进行无迹变换,获取采样点集X(i)(k)及对应权值w(i):
其中,y表示展开维数,α为分布状态因子;η为待选参数,用以确保矩阵(y+λ)P(k)为半正定矩阵,λ=α2(y+η)-y;β为非负待选参数,用于表征状态变量高阶项的影响;y,α,η,β的取值需要根据实际需求设定;
4.1c)计算每个采样点X(i)(k)的一步预测X(i)(k+1|k):
X(i)(k+1|k)=F·X(i)(k)+G·W(k),i=0~2y,
其中,F表示状态转移矩阵,G表示过程噪声矩阵,F、G的取值分别如下:
其中采样时间ts根据实际需求设定;
4.1d)计算状态变量X(k)的一步预测及对应的协方差矩阵P(k+1|k):
4.1e)对一步预测进行无迹变换,获取新的采样点集X(i)(k+1|k):
4.1f)计算每个采样点X(i)(k+1|k)预测的观测量Z(i)(k+1|k):
其中x(i)(k+1|k),y(i)(k+1|k)表示4.1e)中X(i)(k+1|k)的横坐标和纵坐标,V(k)是一个均值为0,方差为R的高斯白噪声,R的取值根据实际环境设定;
4.1g)计算观测量及对应的协方差矩阵和互协方差矩阵
4.1h)根据观测量的协方差矩阵和互协方差矩阵计算卡尔曼滤波增益K(k+1):
4.1i)计算k+1时刻状态估计量及对应的协方差矩阵P(k+1):
6.根据权利要求4所述的方法,其中步骤4.2)中计算k+1时刻的迭代状态估计量及对应的协方差矩阵P(k+1)b,按如下步骤进行:
4.2a)令P(k+1)0=P(k+1|k),P(k+1)1=P(k+1);令b=2,b表示迭代次数;
4.2b)利用无迹变换获取采样点集X(i)(k+1)b:
其中
4.2c)计算迭代一步预测估计
4.2d)计算每个迭代采样点预测的迭代观测量Z(i)(k+1|k)b:
其中x(i)(k+1|k)b,y(i)(k+1|k)b表示4.2b)X(i)(k+1|k)b中对应的横坐标和纵坐标;
4.2e)计算系统预测的迭代观测量及对应的协方差矩阵和互协方差矩阵
4.2f)根据迭代观测量的协方差矩阵和互协方差矩阵计算迭代卡尔曼滤波增益K(k+1)b:
4.2g)计算k+1时刻迭代状态估计量及对应的协方差矩阵P(k+1)b:
其中调整系数s=1;
4.2h)令并判断下式是否成立:
若成立且b≤N,则令b=b+1,s=s·γ,并返回4.2b,其中N为最大迭代次数,需根据具体环境设定,γ为衰减因子,取值范围为0~1;
否则,将和P(k+1)b作为结果输出。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610533697.8A CN106226732B (zh) | 2016-07-08 | 2016-07-08 | 基于tof及迭代无迹滤波的室内无线定位跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610533697.8A CN106226732B (zh) | 2016-07-08 | 2016-07-08 | 基于tof及迭代无迹滤波的室内无线定位跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106226732A true CN106226732A (zh) | 2016-12-14 |
CN106226732B CN106226732B (zh) | 2018-11-16 |
Family
ID=57519111
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610533697.8A Active CN106226732B (zh) | 2016-07-08 | 2016-07-08 | 基于tof及迭代无迹滤波的室内无线定位跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106226732B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106900057A (zh) * | 2017-04-26 | 2017-06-27 | 深圳市尧元科技有限公司 | 一种基于测距的室内定位方法及系统 |
CN108535687A (zh) * | 2018-03-20 | 2018-09-14 | 西安电子科技大学 | 基于tof和rssi信息融合的室内无线定位方法 |
CN108806787A (zh) * | 2018-07-06 | 2018-11-13 | 上海长海医院 | 面向临床手术的医用耗材智能监控系统 |
CN108919092A (zh) * | 2018-06-28 | 2018-11-30 | 芜湖威灵数码科技有限公司 | 一种测试工业测控仪表的故障定位装置 |
CN108924734A (zh) * | 2018-05-24 | 2018-11-30 | 北京理工大学 | 一种三维传感器节点定位方法及系统 |
CN109541541A (zh) * | 2018-12-24 | 2019-03-29 | 广东理致技术有限公司 | 一种室内三角定位精度修正方法及装置 |
CN110730502A (zh) * | 2019-10-23 | 2020-01-24 | 珠海优特电力科技股份有限公司 | 一种定位方法及装置 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102494684A (zh) * | 2011-11-11 | 2012-06-13 | 东南大学 | 一种基于wsn/mins组合导航的导航信息无偏紧组合方法 |
CN102573057A (zh) * | 2012-01-14 | 2012-07-11 | 福建师范大学 | 一种优化的rfid室内定位方法 |
EP2511727A1 (en) * | 2011-04-14 | 2012-10-17 | Navteq North America, LLC | Location tracking |
EP2584372A1 (en) * | 2011-10-17 | 2013-04-24 | Commissariat à l'Énergie Atomique et aux Énergies Alternatives | RSS based positioning method with limited sensitivity receiver |
EP2662703A1 (en) * | 2012-05-10 | 2013-11-13 | 9Solutions Oy | Improving positioning accuracy of location tracking system |
CN104363649A (zh) * | 2014-07-30 | 2015-02-18 | 浙江工业大学 | 带有约束条件的ukf的wsn节点定位方法 |
CN105491661A (zh) * | 2015-12-10 | 2016-04-13 | 上海电机学院 | 基于改进的Kalman滤波算法的室内定位系统及方法 |
-
2016
- 2016-07-08 CN CN201610533697.8A patent/CN106226732B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2511727A1 (en) * | 2011-04-14 | 2012-10-17 | Navteq North America, LLC | Location tracking |
EP2584372A1 (en) * | 2011-10-17 | 2013-04-24 | Commissariat à l'Énergie Atomique et aux Énergies Alternatives | RSS based positioning method with limited sensitivity receiver |
CN102494684A (zh) * | 2011-11-11 | 2012-06-13 | 东南大学 | 一种基于wsn/mins组合导航的导航信息无偏紧组合方法 |
CN102573057A (zh) * | 2012-01-14 | 2012-07-11 | 福建师范大学 | 一种优化的rfid室内定位方法 |
EP2662703A1 (en) * | 2012-05-10 | 2013-11-13 | 9Solutions Oy | Improving positioning accuracy of location tracking system |
CN104363649A (zh) * | 2014-07-30 | 2015-02-18 | 浙江工业大学 | 带有约束条件的ukf的wsn节点定位方法 |
CN105491661A (zh) * | 2015-12-10 | 2016-04-13 | 上海电机学院 | 基于改进的Kalman滤波算法的室内定位系统及方法 |
Non-Patent Citations (2)
Title |
---|
S.B. KOTWAL 等: ""SI WSN localization with Analysis of Energy Consumption and Communication"", 《INTERNATIONAL JOURNAL OF COMPUTER APPLICATIONS》 * |
颜嘉俊 等: ""基于RSSI的无线传感器网络节点定位"", 《计算机仿真》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106900057A (zh) * | 2017-04-26 | 2017-06-27 | 深圳市尧元科技有限公司 | 一种基于测距的室内定位方法及系统 |
CN106900057B (zh) * | 2017-04-26 | 2020-06-12 | 深圳先进技术研究院 | 一种基于测距的室内定位方法及系统 |
CN108535687A (zh) * | 2018-03-20 | 2018-09-14 | 西安电子科技大学 | 基于tof和rssi信息融合的室内无线定位方法 |
CN108535687B (zh) * | 2018-03-20 | 2021-05-18 | 西安电子科技大学 | 基于tof和rssi信息融合的室内无线定位方法 |
CN108924734A (zh) * | 2018-05-24 | 2018-11-30 | 北京理工大学 | 一种三维传感器节点定位方法及系统 |
CN108924734B (zh) * | 2018-05-24 | 2020-08-11 | 北京理工大学 | 一种三维传感器节点定位方法及系统 |
CN108919092A (zh) * | 2018-06-28 | 2018-11-30 | 芜湖威灵数码科技有限公司 | 一种测试工业测控仪表的故障定位装置 |
CN108806787A (zh) * | 2018-07-06 | 2018-11-13 | 上海长海医院 | 面向临床手术的医用耗材智能监控系统 |
CN109541541A (zh) * | 2018-12-24 | 2019-03-29 | 广东理致技术有限公司 | 一种室内三角定位精度修正方法及装置 |
CN109541541B (zh) * | 2018-12-24 | 2022-11-08 | 广东理致技术有限公司 | 一种室内三角定位精度修正方法及装置 |
CN110730502A (zh) * | 2019-10-23 | 2020-01-24 | 珠海优特电力科技股份有限公司 | 一种定位方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN106226732B (zh) | 2018-11-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106226732B (zh) | 基于tof及迭代无迹滤波的室内无线定位跟踪方法 | |
Yang et al. | A novel NLOS error compensation method based IMU for UWB indoor positioning system | |
Su et al. | Localization and data collection in AUV-aided underwater sensor networks: Challenges and opportunities | |
Fengzhong et al. | A survey of ranging algorithms and localization schemes in underwater acoustic sensor network | |
CN103561463B (zh) | 一种基于样本聚类的rbf神经网络室内定位方法 | |
CN101109804A (zh) | 一种对无线传感器网络进行三维快速定位的系统和方法 | |
CN108535687A (zh) | 基于tof和rssi信息融合的室内无线定位方法 | |
CN103648164B (zh) | 一种基于到达时间差和Gossip算法的无线传感器网络分布式定位方法 | |
CN107071732B (zh) | 一种基于rssi的mle-pso室内定位方法 | |
CN110926461A (zh) | 一种基于超宽带室内定位方法和系统、导航方法和系统 | |
CN108413966A (zh) | 基于多种传感测距技术室内定位系统的定位方法 | |
Wang et al. | Feasibility study of UAV-assisted anti-jamming positioning | |
CN105334495A (zh) | 一种无线网络中基于信号到达时间的非视距稳健定位方法 | |
CN103841641A (zh) | 一种基于到达角度和Gossip算法的无线传感器网络分布式协作定位方法 | |
Barr et al. | An Efficient Method for Constructing Underwater Sensor Barriers. | |
CN112865897A (zh) | 一种无人机对地面场景的非平稳信道仿真方法及系统 | |
Mozamir et al. | Indoor localization estimation techniques in wireless sensor network: A review | |
Bouras et al. | Time difference of arrival localization study for SAR systems over LoRaWAN | |
CN102711043B (zh) | 适用于节点分布稀疏的基于rss的无源运动跟踪方法 | |
CN110519693A (zh) | 一种面向智能移动终端的融合定位方法 | |
CN108810840B (zh) | 协作定位中基于efim和距离协作的节点选择方法 | |
Ahmed et al. | Localization schemes in underwater sensor network (UWSN): A survey | |
Li et al. | Time difference of arrival location method based on improved snake optimization algorithm | |
Xu et al. | An improved MDS localisation algorithm for a WSN in a sub-surface mine | |
CN103037503A (zh) | 一种无线传感器网络定位方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 |