原文: http://wjf88223.blog.163.com/blog/static/35168001201142581034694/
说明:
1.这个人员定位小方案只是面向于化工厂等一些具有一定危险性的室内空间.
4、目标定位算法设计方案
本方案采用基于RSSI测距的定位算法,即已知发射数据的节点(移动目标节点)在发射数据时的发射功率,根据接收节点(参考节点)测量其接收到的信号功率,计算信号的传播损耗,利用理论模型将传输损耗转化为距离,再利用相关算法计算出目标节点的位置。
(1)RSSI测距模型
接收信号强度RSSI是传输功率和传输距离(发送节点与接收节点之间的距离)的函数。RSSI值会随着距离的增加按如式(4—1)递减:
(4—1)
其中n为信号传播常数,与信号的传输环境有关;d为接收节点与发送节点之间的距离;A为距离发送节点1米时的信号强度。
A和n的取值不同,对测量的误差影响会很大,为了尽可能提高基于RSSI测距定位的精度,参数A和n的取值预先由工作人员在实际定位区域进行测量计算。理论上A的值在各个方向上应该是一致的,但由于发射节点和接收节点天线的各向性,使它的值并不一定相同,因此需要进行多次测量并取平均值。因为n与信号传播环境有关,它的值是不断变化的,工作人员需要先在定位区域通过测量得到一组n值,然后在参考节点布置好以后,尝试使用不同的值以寻找一个最适合该区域环境的值。
(2)参考节点RSSI值滤波处理
[本段滤波算法参考文献《基于RSSI的室内无线网络定位研究技术》]
在参考节点接收到 n次(本方案设置 n值为 50)移动目标节点发送的带 RSSI值的信息包后,由于受到视距和多径等外界环境因素影响,得到 RSSI值会具有比较大的波动性,因而先进行滤波处理,得到一个比较准确的值再进行计算。
由于在自然现象和社会现象中,大量随机变量服从或近似服从正态分布,如材料性能、化学成分和测量误差等,因此本方案采用高斯滤波模型进行RSSI滤波。
高概率发生区,选择概率大于0.6的范围(一般工程中的经验值为0.6)。经过高斯滤波后,RSSI的取值范围为
然后再把该范围内的RSSI值取出,求几何平均值,得到最终的RSSI值,最后参考节点把这个RSSI值以及本节点的网络地址ID一起发送到移动目标节点。
(3)移动目标节点RSSI值阀值处理
移动目标节点广播RSSI信息包后,会接收所有一跳范围内参考节点发回的最终RSSI值和对应的网络地址ID,本方案网络布局的宗旨为:任意一小块定位区域,至少位于三个参考节点的定位半径内,并且与三个参考节点都保持可视性。如果一块小区域满足上述宗旨,则满足可视性的参考节点所得到的RSSI值是最准确的,利用这些RSSI值测得的移动目标节点坐标的精度也是最高的,但如果移动目标节点一跳范围内还有一些不满足可视性的参考节点,由于障碍物的影响,这些参考节点得到的RSSI值会比那些满足可视性参考节点得到的RSSI值小,最终会降低移动目标节点的定位精度。本方案采用一个阀值处理过程来滤除那些一跳范围内受障碍物影响很大的参考节点所发送的RSSI值。
设阀值为,的取值预先由工作人员在定位现场测量得到。假设参考节点的定位半径为r,参考节点在距离移动目标节点为r处接收到50个RSSI信息包后,通过(2)中的优化步骤得到一个RSSI值,为了提高定位精度,多次测量,取最终的平均值作为阀值。
假设移动目标节点接收到一跳范围内n个参考节点的RSSI值RSSIi,i=0,1,…,n,x为的个数。如果x>=3,则打包x个RSSI值以及对应参考节点网络地址ID发送到基站,基站再发送到中心计算机;如果x<3,即对应于一些十分偏僻的特殊区域,则将n个RSSI值以递减方式排列,打包前个RSSI值(为向上取整)以及对应参考节点的网络地址ID发送到基站,,基站再发送到中心计算机。
(4)移动目标节点坐标计算
中心计算机接收到参考节点发送上来的RSSI值后,根据式(4—1)得到它们之间的距离,然后进行移动目标坐标的计算。本方案采用极大似然估计法来计算移动目标节点的坐标。已知n个参考节点(P1,P2,...,Pn)的高度分别为(H1,H2,...,Hn),坐标分别为(x1,y1),(x2,y2),...,(xn,yn),移动目标节点D的高度为h,通过RSSI值得到各参考节点距离移动目标节点M的距离为(L1,L2,...,Ln),设各参考节点距离移动目标节点D的距离映射到定位区域坐标轴上为(d1,d2,...,dn),如图10所示。
图10 n个参考节点与移动目标节点
根据式(2—1)可以得到:
(4—2)设移动目标节点D的坐标为(xD,yD),则有
(4—3)
从第一个方程开始,分别减去最后一个方程,得到
(4—4)
令
由于存在测距误差,合理的线性模型应该是,其中,N为n -1维随机误差向量。可以求解移动目标节点D的极大似然估计和非线性最小二乘估计节点D的位置为:
(4—5)
5、目标跟踪算法设计方案
如何以最低的能量代价高效地融合有效信息是各种目标跟踪算法的核心问题。若要提高目标跟踪精度,必须需要较多节点的数据,这就会带来较高的能量开销。反过来,若要节省能量,就只能在有限范围内进行通信和计算,那么结果精度就会受到影响。由于本方案采用zigbee协议,基站为协调器,参考节点具有路由功能,移动目标节点为终端,参考节点有固定电源供电,可以不用考虑能量消耗的问题,而把重点放在提高移动目标定位精度上。中心计算机将根据已有的移动目标节点历史坐标数据和当前获得的最新坐标数据进行线性拟合,计算移动目标的运动轨迹,并在定位区域示意图上显示移动目标节点的轨迹,实现对移动目标节点的跟踪。