基于动态环境衰减因子的粒子滤波室内定位方法及系统

申请号 CN201510171984.4 申请日 2015-04-13 公开(公告)号 CN104898087A 公开(公告)日 2015-09-09
申请人 福建师范大学; 发明人 肖如良; 李奕诺; 倪友聪; 杜欣; 蔡声镇;
摘要 本 发明 涉及 定位 领域,尤其是涉及一种基于动态环境衰减因子的粒子滤波室内定位方法及系统。所述基于动态环境衰减因子的粒子滤波室内定位方法包括:由激发器发出激发 信号 给移动卡片,所述移动卡片发出多个接收信号强度数据,通过三个 读卡器 获取移动卡片发出的接收信号强度数据并对所述接收信号强度数据进行预处理。由于本发明提供的室内定位方法及系统是应用在嘈杂以及时刻变化的动态环境条件,因此结合动态环境衰减模型来计算移动卡片与三个读卡器之间的距离,并利用三边定位 算法 计算得移动卡片的准确 位置 。本发明有益效果:实现能够很好地调和不同位置带来的环境噪声差异,以及在室内定位中有较高的定位 精度 和较好的 稳定性 。
权利要求

1.一种基于动态环境衰减因子的粒子滤波室内定位方法,其特征在于,包括以下步骤:
S100、建立状态空间的二维坐标系,将三个读卡器和激发器设置在所述状态空间内的指定位置,将移动卡片设置在所述状态空间内的任一位置,所述移动卡片接收到激发器的激发信号后,所述移动卡片发出多个接收信号强度数据,所述读卡器接收移动卡片发出的接收信号强度数据,从所述状态空间中随机采样多个粒子作为采样粒子;
S200、将每个采样粒子代入状态转移方程得每个采样粒子的系统状态值;
S300、当预设时刻到达时,将步骤S200所得每个采样粒子的系统状态值计算每个采样粒子的系统状态的真实值;计算每个采样粒子的后验概率密度,选取具有最大的后验概率密度的采样粒子作为第一采样粒子,所述第一采样粒子的系统状态的真实值作为最优状态值;
S400、将步骤S300所得最优状态值计算得动态环境衰减因子,根据所得动态环境衰减因子计算所述移动卡片分别到三个读卡器的三个距离值;
S500、将步骤S400所得三个距离值代入三边定位模型计算得所述移动卡片的二维坐标。
2.根据权利要求1所述的基于动态环境衰减因子的粒子滤波室内定位方法,其特征在于,所述步骤S400还包括:将步骤S100所得每个采样粒子代入观测方程得观测值,根据所得观测值计算每一采样粒子的权重,且将所得权重进行归一化处理;根据归一化处理后所得权重计算有效采样粒子个数,若所述有效采样粒子个数小于预设值,进行重采样得新的采样粒子,返回至步骤S200。
3.根据权利要求2所述的基于动态环境衰减因子的粒子滤波室内定位方法,其特征在于,所述重采样采用残差重采样。
4.根据权利要求1所述的基于动态环境衰减因子的粒子滤波室内定位方法,其特征在于,所述步骤S500具体为:将步骤S400所得三个距离值和三个读卡器的坐标代入三边定位模型,并采用最小二乘法计算得所述移动卡片的二维坐标。
5.根据权利要求1所述的基于动态环境衰减因子的粒子滤波室内定位方法,其特征在于,所述移动卡片为有源的移动卡片。
6.一种基于动态环境衰减因子的粒子滤波室内定位系统,其特征在于,包括激发器、移动卡片、计算机和三个读卡器;建立状态空间的二维坐标系,所述读卡器和激发器设置在所述状态空间内的指定位置,所述移动卡片设置在所述状态空间内的任一位置,所述移动卡片接收到激发器的激发信号后,所述移动卡片发出多个接收信号强度数据,所述读卡器接收移动卡片发出的接收信号强度数据,所述读卡器通过无线连接将所述接收信号强度数据发送给所述计算机;所述读卡器从所述状态空间中随机采样多个粒子作为采样粒子发送给所述计算机;
所述计算机包括第一计算单元、第二计算单元、第三计算单元、选取单元、第四计算单元、第五计算单元和第六计算单元;
所述第一计算单元,用于将每个采样粒子代入状态转移方程得每个采样粒子的系统状态值;
所述第二计算单元,用于当达到预设时刻时,将第一计算单元所得每个采样粒子的系统状态值计算每个采样粒子的系统状态的真实值;
所述第三计算单元,用于计算每个采样粒子的后验概率密度;
所述选取单元,用于选取具有最大的后验概率密度的采样粒子作为第一采样粒子,所述第一采样粒子的系统状态的真实值作为最优状态值;
所述第四计算单元,用于将选取单元所得最优状态值计算得动态环境衰减因子;
所述第五计算单元,用于根据所得动态环境衰减因子计算所述移动卡片分别到三个读卡器的三个距离值;
所述第六计算单元,用于将第五计算单元所得三个距离值代入三边定位模型计算得所述移动卡片的二维坐标。
7.根据权利要求6所述的基于动态环境衰减因子的粒子滤波室内定位系统,其特征在于,该系统还包括第七计算单元、第八计算单元、归一化单元、第九计算单元、重采样单元和返回单元;
所述第七计算单元,用于将读卡器所得每个采样粒子代入观测方程得观测值;
所述第八计算单元,用于根据第七计算单元所得观测值计算每一采样粒子的权重;
所述归一化单元,用于将所得权重进行归一化处理;
所述第九计算单元,用于根据第八计算单元所得归一化处理后的权重计算有效采样粒子个数;
所述重采样单元,用于若所述有效采样粒子个数小于预设阀值,进行重采样得新的采样粒子;
所述返回单元,用于当进行重采样时,返回至第一计算单元。
8.根据权利要求7所述的基于动态环境衰减因子的粒子滤波室内定位系统,其特征在于,所述重采样单元采用残差重采样算法进行重采样。
9.根据权利要求6所述的基于动态环境衰减因子的粒子滤波室内定位系统,其特征在于,所述第六计算单元具体用于将第五计算单元所得三个距离值和三个读卡器的坐标代入三边定位模型,并采用最小二乘法计算得所述移动卡片的二维坐标。
10.根据权利要求6所述的基于动态环境衰减因子的粒子滤波室内定位系统,其特征在于,所述移动卡片为有源的移动卡片。

说明书全文

基于动态环境衰减因子的粒子滤波室内定位方法及系统

技术领域

[0001] 本发明涉及定位领域,尤其是涉及一种基于动态环境衰减因子的粒子滤波室内定位方法及系统。

背景技术

[0002] 随着社会的发展,人员和物品的位置信息越来越受到人们的重视。现有定位技术包括GPS定位、Wi-Fi定位技术应用到室内都有一定的局限性,例如,GPS定位信号无法穿透建筑物,造成室内定位精度不高;Wi-Fi定位信号覆盖范围太小且容易受到其他信号的干扰,也导致定位精度不够。无线传感器网络(Wireless Sensor Network,WSN)作为一种全新的信息获取和处理技术,有着广泛的应用领域,其中,传感器节点的定位技术是无线传感器网络中应用最广泛的技术之一。在实际应用中,节点位置信息的准确性直接关系到传感器节点采集到信息的有效性。作为无线通信技术的一种,无线射频识别技术(Radio Frequency Identification,RFID)已被证明在人员和物品定位的应用中具有较强的优势,无论从技术层面还是实际配置层面考量,它都可以弥补GPS定位和Wi-Fi定位在室内应用的不足,因此,RFID具有更广泛的应用。
[0003] 根据定位过程中是否需要测量源节点和目标节点之间的距离,可以把定位算法分为两大类:基于距离(range-based)的定位算法和距离无关(range-free)的定位算法。基于距离的定位通过测量源节点和目标节点之间的距离或度,然后利用三边测量或三角测量计算出目标节点的位置坐标。基于距离的定位算法有很多种,主要有比较接收信号强度(Received Signal Strength Indication,RSSI)、比较到达时间(Time Of Arrival,TOA)、时间差(Time Difference of Arrival,TDOA)和到达角度(Angle-of-Arrival,AOA)。其中,以TDOA和RSSI测距定位最为常用。
[0004] 然而,在实际应用过程中发现,复杂的环境对无线信号有着强烈的干扰作用,导致测得的信号强度值和理论值有较大误差。有效地解决这个挑战性困难问题是获得高精度位置信息的关键,需要对接收到的信号强度值进行一定的预处理。
[0005] 针对复杂环境这一挑战性困难,国内外已有大量的研究工作。采用不同的模型和不同的预处理方法也会得到不同的定位精度和稳定性。在模型选择方面,Bahl构造了墙壁衰减因子模型(Wall Attenuation Factor,WAF),充分考虑了建筑空间布局对定位性能的影响。林景栋采用简化的无线电波传播模型,该模型可以达到一定的定位精度,但是随着信标节点分布情况的不同,该模型定位精度和稳定性有较大波动。石为人使用了定值环境衰减因子模型,由于其取值为定值,所以对目标节点的环境补偿不能很好地适应位置的变化。在数据处理方面,利用顿插值多项式代替线性插值来计算目标节点的RSSI值,该方法虽然提高了定位精度,但却产生很大的时间复杂性。朱宇佳采用支持向量机多分类方法把目标节点的RSSI值归于若干类中的某一类中进行处理,该算法定位精度有一定提高,但由于需要离线采集数据,故其适应环境变化的能不强。张正华采用优化加权质心定位算法,定位精度在0.5~2.2米;肖如良首先应用卡尔曼滤波平滑了随机误差,然后用中位加权方法抑制了显著误差,其误差在0.81~1米之间。Bekkali结合卡尔曼滤波技术处理接收到的RSSI值,并采用多标签构成一种映射的方式,其误差在0.5~5米之间,但稳定性很差。
[0006] 以上诸多工作应对这一挑战性困难的解决方案在精度与稳定性方面还有待我们进一步探索,考虑到复杂环境中因距离相同而位置不同带来的环境差异,因此,需要提供一种基于动态环境衰减因子的粒子滤波室内定位方法及系统,能够很好地调和不同位置带来的环境噪声差异,以及在室内定位中有较高的定位精度和较好的稳定性。

发明内容

[0007] 本发明所要解决的技术问题是:提供一种基于动态环境衰减因子的粒子滤波室内定位方法及系统,能够很好地调和不同位置带来的环境噪声差异,实现较高的定位精度和较好的稳定性。
[0008] 为了解决上述技术问题,本发明采用的技术方案为:
[0009] 一种基于动态环境衰减因子的粒子滤波室内定位方法,包括以下步骤:
[0010] S100、建立状态空间的二维坐标系,将三个读卡器和激发器设置在所述状态空间内的指定位置,将移动卡片设置在所述状态空间内的任一位置,所述移动卡片接收到激发器的激发信号后,所述移动卡片发出多个接收信号强度数据,所述读卡器接收移动卡片发出的接收信号强度数据,从所述状态空间中随机采样多个粒子作为采样粒子;
[0011] S200、将每个采样粒子代入状态转移方程得每个采样粒子的系统状态值;
[0012] S300、当预设时刻到达时,将步骤S200所得每个采样粒子的系统状态值计算每个采样粒子的系统状态的真实值;计算每个采样粒子的后验概率密度,选取具有最大的后验概率密度的采样粒子作为第一采样粒子,所述第一采样粒子的系统状态的真实值作为最优状态值;
[0013] S400、将步骤S300所得最优状态值计算得动态环境衰减因子,根据所得动态环境衰减因子计算所述移动卡片分别到三个读卡器的三个距离值;
[0014] S500、将步骤S400所得三个距离值代入三边定位模型计算得所述移动卡片的二维坐标。
[0015] 本发明采用的另一技术方案为:
[0016] 一种基于动态环境衰减因子的粒子滤波室内定位系统,包括激发器、移动卡片、计算机和三个读卡器;建立状态空间的二维坐标系,所述读卡器和激发器设置在所述状态空间内的指定位置,所述移动卡片设置在所述状态空间内的任一位置,所述移动卡片接收到激发器的激发信号后,所述移动卡片发出多个接收信号强度数据,所述读卡器接收移动卡片发出的接收信号强度数据,所述读卡器通过无线连接将所述接收信号强度数据发送给所述计算机;所述读卡器从所述状态空间中随机采样多个粒子作为采样粒子发送给所述计算机;
[0017] 所述计算机包括第一计算单元、第二计算单元、第三计算单元、选取单元、第四计算单元、第五计算单元和第六计算单元;
[0018] 所述第一计算单元,用于将每个采样粒子代入状态转移方程得每个采样粒子的系统状态值;
[0019] 所述第二计算单元,用于当达到预设时刻时,将第一计算单元所得每个采样粒子的系统状态值计算每个采样粒子的系统状态的真实值;
[0020] 所述第三计算单元,用于计算每个采样粒子的后验概率密度;
[0021] 所述选取单元,用于选取具有最大的后验概率密度的采样粒子作为第一采样粒子,所述第一采样粒子的系统状态的真实值作为最优状态值;
[0022] 所述第四计算单元,用于将选取单元所得最优状态值计算得动态环境衰减因子;
[0023] 所述第五计算单元,用于根据所得动态环境衰减因子计算所述移动卡片分别到三个读卡器的三个距离值;
[0024] 所述第六计算单元,用于将第五计算单元所得三个距离值代入三边定位模型计算得所述移动卡片的二维坐标。
[0025] 本发明的有益效果在于:由激发器发出激发信号给移动卡片,所述移动卡片发出多个接收信号强度数据,通过三个读卡器获取移动卡片发出的接收信号强度数据并对所述接收信号强度数据进行预处理。由于本发明提供的室内定位方法及系统是应用在嘈杂以及时刻变化的动态环境条件,因此结合动态环境衰减模型来计算移动卡片与三个读卡器之间的距离,并利用三边定位算法计算得移动卡片的准确位置,本发明的技术方案能够实现很好地调和不同位置带来的环境噪声差异,以及在室内定位中有较高的定位精度和较好的稳定性。附图说明
[0026] 图1为本发明具体实施方式实施例2中实验室的环境和读卡器的位置示意图;
[0027] 图2为本发明具体实施方式实施例2中引入环境衰减因素模型的实验结果示意图;
[0028] 图3为本发明具体实施方式实施例2中未引入环境衰减因素模型的实验结果示意图。

具体实施方式

[0029] 为详细说明本发明的技术内容、所实现目的及效果,以下结合实施方式并配合附图予以说明。
[0030] 本发明最关键的构思在于:通过三个读卡器获取移动卡片发出的接收信号强度数据并对所述接收信号强度数据进行预处理,结合动态环境衰减模型来计算移动卡片与三个读卡器之间的距离,并利用三边定位算法计算得移动卡片的准确位置,能够实现很好地调和不同位置带来的环境噪声差异,以及在室内定位中有较高的定位精度和较好的稳定性。
[0031] 本发明具体实施方式的基于动态环境衰减因子的粒子滤波室内定位方法,具体如下:
[0032] 一种基于动态环境衰减因子的粒子滤波室内定位方法,包括以下步骤:
[0033] S100、建立状态空间的二维坐标系,将三个读卡器和激发器设置在所述状态空间内的指定位置,将移动卡片设置在所述状态空间内的任一位置,所述移动卡片接收到激发器的激发信号后,所述移动卡片发出多个接收信号强度数据,所述读卡器接收移动卡片发出的接收信号强度数据,从所述状态空间中随机采样多个粒子作为采样粒子;
[0034] S200、将每个采样粒子代入状态转移方程得每个采样粒子的系统状态值;
[0035] S300、当预设时刻到达时,将步骤S200所得每个采样粒子的系统状态值计算每个采样粒子的系统状态的真实值;计算每个采样粒子的后验概率密度,选取具有最大的后验概率密度的采样粒子作为第一采样粒子,所述第一采样粒子的系统状态的真实值作为最优状态值;
[0036] S400、将步骤S300所得最优状态值计算得动态环境衰减因子,根据所得动态环境衰减因子计算所述移动卡片分别到三个读卡器的三个距离值;
[0037] S500、将步骤S400所得三个距离值代入三边定位模型计算得所述移动卡片的二维坐标。
[0038] 从上述描述可知,本发明的有益效果在于:由激发器发出激发信号给移动卡片,所述移动卡片发出多个接收信号强度数据,通过三个读卡器获取移动卡片发出的接收信号强度数据并对所述接收信号强度数据进行预处理。由于本发明提供的室内定位方法是应用在嘈杂以及时刻变化的动态环境条件,因此结合动态环境衰减模型来计算移动卡片与三个读卡器之间的距离,并利用三边定位算法计算得移动卡片的准确位置,能够实现很好地调和不同位置带来的环境噪声差异,以及在室内定位中有较高的定位精度和较好的稳定性。
[0039] 进一步的,所述步骤S400还包括:将步骤S100所得每个采样粒子代入观测方程得观测值,根据所得观测值计算每一采样粒子的权重,且将所得权重进行归一化处理;根据归一化处理后所得权重计算有效采样粒子个数,若所述有效采样粒子个数小于预设值,进行重采样得新的采样粒子,返回至步骤S200。
[0040] 由上述描述可知,由于标准粒子滤波算法存在权值退化的现象,即迭代一定次数后,采样粒子只有极少数具有较大权值,其余采样粒子的权值可以忽略不计,造成大量计算浪费在计算权值较小的粒子上,故需要重采样来舍弃权值较小的粒子,以权值较大的粒子进行取代。
[0041] 进一步的,所述重采样采用残差重采样。目前最为常用的重采样算法有分层重采样、系统重采样、多项式重采样和残差重采样四种。其中,除残差重采样外的三种重采样方法的唯一区别是产生均匀分布的随机数的方式不同。不像其他三种重采样算法那样对每一个粒子都不加区分地进行比较和循环,残差重采样开始就抛弃了权值为零的粒子,具有效率高、方便实现的特点。
[0042] 进一步的,所述步骤S500具体为:将步骤S400所得三个距离值和三个读卡器的坐标代入三边定位模型,并采用最小二乘法计算得所述移动卡片的二维坐标。
[0043] 由上述描述可知,通过三边定位配合最小二乘法能够有效地提高定位精度,得到移动卡片的精确位置。
[0044] 进一步的,所述移动卡片为有源的移动卡片。
[0045] 由上述描述可知,有源的移动卡片可通过激发器后以自发形式发送存储的接收信号强度数据。
[0046] 本发明具体实施方式的基于动态环境衰减因子的粒子滤波室内定位系统,具体如下:
[0047] 一种基于动态环境衰减因子的粒子滤波室内定位系统,包括激发器、移动卡片、计算机和三个读卡器;建立状态空间的二维坐标系,所述读卡器和激发器设置在所述状态空间内的指定位置,所述移动卡片设置在所述状态空间内的任一位置,所述移动卡片接收到激发器的激发信号后,所述移动卡片发出多个接收信号强度数据,所述读卡器接收移动卡片发出的接收信号强度数据,所述读卡器通过无线连接将所述接收信号强度数据发送给所述计算机;所述读卡器从所述状态空间中随机采样多个粒子作为采样粒子发送给所述计算机;
[0048] 所述计算机包括第一计算单元、第二计算单元、第三计算单元、选取单元、第四计算单元、第五计算单元和第六计算单元;
[0049] 所述第一计算单元,用于将每个采样粒子代入状态转移方程得每个采样粒子的系统状态值;
[0050] 所述第二计算单元,用于当达到预设时刻时,将第一计算单元所得每个采样粒子的系统状态值计算每个采样粒子的系统状态的真实值;
[0051] 所述第三计算单元,用于计算每个采样粒子的后验概率密度;
[0052] 所述选取单元,用于选取具有最大的后验概率密度的采样粒子作为第一采样粒子,所述第一采样粒子的系统状态的真实值作为最优状态值;
[0053] 所述第四计算单元,用于将选取单元所得最优状态值计算得动态环境衰减因子;
[0054] 所述第五计算单元,用于根据所得动态环境衰减因子计算所述移动卡片分别到三个读卡器的三个距离值;
[0055] 所述第六计算单元,用于将第五计算单元所得三个距离值代入三边定位模型计算得所述移动卡片的二维坐标。
[0056] 从上述描述可知,本发明的有益效果在于:由激发器发出激发信号给移动卡片,所述移动卡片发出多个接收信号强度数据,通过三个读卡器获取移动卡片发出的接收信号强度数据并对所述接收信号强度数据进行预处理。由于本发明提供的室内定位系统是应用在嘈杂以及时刻变化的动态环境条件,因此结合动态环境衰减模型来计算移动卡片与三个读卡器之间的距离,并利用三边定位算法计算得移动卡片的准确位置,能够实现很好地调和不同位置带来的环境噪声差异,以及在室内定位中有较高的定位精度和较好的稳定性。
[0057] 进一步的,该系统还包括第七计算单元、第八计算单元、归一化单元、第九计算单元、重采样单元和返回单元;
[0058] 所述第七计算单元,用于将读卡器所得每个采样粒子代入观测方程得观测值;
[0059] 所述第八计算单元,用于根据第七计算单元所得观测值计算每一采样粒子的权重;
[0060] 所述归一化单元,用于将所得权重进行归一化处理;
[0061] 所述第九计算单元,用于根据第八计算单元所得归一化处理后的权重计算有效采样粒子个数;
[0062] 所述重采样单元,用于若所述有效采样粒子个数小于预设阀值,进行重采样得新的采样粒子;
[0063] 所述返回单元,用于当进行重采样时,返回至第一计算单元。
[0064] 由上述描述可知,由于标准粒子滤波算法存在权值退化的现象,即迭代一定次数后,采样粒子只有极少数具有较大权值,其余采样粒子的权值可以忽略不计,造成大量计算浪费在计算权值较小的粒子上,故需要重采样来舍弃权值较小的粒子,以权值较大的粒子进行取代。
[0065] 进一步的,所述重采样单元采用残差重采样算法进行重采样。
[0066] 进一步的,所述第六计算单元具体用于将第五计算单元所得三个距离值和三个读卡器的坐标代入三边定位模型,并采用最小二乘法计算得所述移动卡片的二维坐标。
[0067] 由上述描述可知,通过三边定位配合最小二乘法能够有效地提高定位精度,得到移动卡片的精确位置。
[0068] 进一步的,所述移动卡片为有源的移动卡片,所述激发器的型号为SYEXS1-LF1,所述激发器的工作频率为125KHz。
[0069] 实施例1
[0070] 本发明提供的一种基于动态环境衰减因子的粒子滤波室内定位方法,包括以下步骤:
[0071] S100、建立状态空间的二维坐标系,将三个读卡器和激发器设置在所述状态空间内的指定位置,将移动卡片设置在所述状态空间内的任一位置,所述移动卡片接收到激发器的激发信号后,所述移动卡片发出50个接收信号强度数据,所述读卡器接收移动卡片发出的接收信号强度数据,从所述状态空间中随机采样500个粒子作为采样粒子;
[0072] S200、将每个采样粒子代入状态转移方程得每个采样粒子的系统状态值;
[0073] 根据动态系统的状态空间模型描述为:
[0074] 其中f(·),h(·)分别为状态转移方程与观测方程,xk为系统状态值,yk为观测值,uk为过程噪声,vk为观测噪声。公式中k-1为k的上一时刻,这里u是一个动态量,k指某一时刻。
[0075] S300、当预设时刻到达时,将步骤S200所得每个采样粒子的系统状态值计算每个采样粒子的系统状态的真实值;计算每个采样粒子的后验概率密度,选取具有最大的后验概率密度的采样粒子作为第一采样粒子,所述第一采样粒子的系统状态的真实值作为最优状态值;
[0076] 所述预设时刻为k时刻,当k时刻到达时,根据步骤S200所得每个采样粒子的系统状态值计算每个采样粒子的系统状态的真实值,具体为:
[0077] 根据公式 得k时刻每个采样粒子系统状态的真实*
值,其中RSSI_Particlelj为系统状态值,wj为归一化的权重,RSSIk为k时刻系统状态的真实值。
[0078] 计算k时刻的每个采样粒子的后验概率密度,具体为:
[0079] 根据公式 得后验概率密度。
[0080] S400、将步骤S100所得每个采样粒子代入观测方程得观测值,根据所得观测值计算每一采样粒子的权重,且将所得权重进行归一化处理;根据归一化处理后所得权重计算有效采样粒子个数,若所述有效采样粒子个数小于预设阀值,进行重采样得新的采样粒子,返回至步骤S200;将步骤S300所得最优状态值计算得动态环境衰减因子,根据所得动态环境衰减因子计算所述移动卡片分别到三个读卡器的三个距离值;
[0081] 根据所述观测值计算每一采样粒子的权重Wj,具体为:
[0082]
[0083] 其中,p(xj|Yk)为粒子xj的后验概率密度函数,q(xj|Yk)为粒子xj的重要性概率密度函数。
[0084] 将所得权重进行归一化处理,具体为:
[0085]
[0086] 计算有效采样粒子个数的公式如下:
[0087]
[0088] 其中,Neffw为有效粒子个数。
[0089] 根据所述最优状态值计算k时刻系统状态的动态环境衰减因子,具体为:
[0090] DEAF=(3A-RSSI_Last1-RSSI_Last2-RSSI_Last3)/L
[0091] 其中,DEAF表示为动态环境衰减因子,A表示为移动卡片与读卡器之间的距离为1米时测得的信号强度,RSSI_Last1表示第一台读卡器的最优状态值,RSSI_Last2表示第二台读卡器的最优状态值,RSSI_Last3表示第二台读卡器的最优状态值,L为状态空间对角线长度的一半。
[0092] 根据所得动态环境衰减因子计算所述移动卡片分别到三个读卡器的三个距离值,具体为:
[0093]
[0094] 其中d表示为移动卡片到读卡器的距离,A表示为移动卡片与读卡器之间的距离为1米时测得的信号强度,RSSI即为RSSI_Last1、RSSI_Last2或RSSI_Last3,n表示为信号衰减因子;
[0095] 参数A的得到方式为:
[0096] 将移动卡片置于距离读卡器的1米处,所述读卡器在预设时长内(例如:1分钟)对移动卡片的信号强度值进行采样并记录信号强度值,从所有记录的信号强度值中选取出最大的一个信号强度值为参数A。
[0097] 三个读卡器会得到三个最优状态值,将三个最优状态值代入公式,得到三个读卡器与移动卡片之间的三个距离值,分别为d1、
d2、d3。
[0098] S500、将步骤S400所得三个距离值和三个读卡器的坐标代入三边定位模型,并采用最小二乘法计算得所述移动卡片的二维坐标。
[0099] 三个读卡器的坐标为已知,分别为p1(x1,y1)、p2(x2,y2)和p3(x3,y3),假设移动卡片的坐标为p(x,y),根据三边定位模型:
[0100]
[0101] 令ri2=di2-xi2-yi2,i=1,2,3;M2=x2+y2;
[0102] 则上式可以化为:
[0103]
[0104] 令
[0105] 上式可改写为:Qθ=b;
[0106] 可得最小二乘解:
[0107] 最终 中的(x,y)就是求出的移动卡片的坐标。
[0108] 通过三边定位配合最小二乘法能够有效地提高定位精度,得到移动卡片的精确位置。
[0109] 实施例2
[0110] 与实施例1的技术方案基本一致,除了读卡器与激发器的设置位置,具体为:状态空间一般为长方体,将三个读卡器和一个激发器分别放在四个角落,读卡器接收信号强度范围较为均衡,每个仪器都有各自的ID编码,可通过ID编码相互进行连接。
[0111] 具体实验过程:
[0112] 为了证实本发明提供的方法及系统在复杂的室内环境具有良好的精确度和稳定性,选择电脑信号干扰多、人员走动频繁、物品摆设多的软件大楼506-A实验室作为测试场所。
[0113] 测试硬件包括一个定位激发器(携带多个天线)、一台计算机、3个读卡器(即锚节点)和若干移动卡片(即目标节点)。定位激发器是SYEXS1-LF1,工作频率是125KHZ,数据接口是RS485,激发距离是0.5~10.0m,工作环境是-20~65℃,5~95%RH。计算机是处理器为Inter(R)Core 2Duo E7500@2.93GHZ,内存为三星DDR3,速度为1067MHZ的lenevo启天M710E。读卡器是频率2.40~2.48GHZ,频道316,信号强度0~255,信号质量0~255,通信速率是2400bps~1152000bps的XT200。实验室的环境和读卡器的位置,如图1所示。
[0114] 读卡器上读取从移动卡片发出来的信号信息的计算机软件是Xtive_XT200_V7V0109.exe以及对其进行调参的MDNET_Tools_V0184.exe,这两个软件是由Xtive公司为Xtive软件配套工具。
[0115] 测试的流程是从移动卡片发送信号到读卡器,利用计算机上的Xtive_XT200_V7V0109.exe读取信号信息,关键就是RSSI,因此设定移动卡片每秒发送10个RSSI值,本发明只取前5秒的50个RSSI值进行预处理,同时在10个不同的时间点以及不同的位置获取实验的数据,即进行了10次随机实验进行了对比实验。
[0116] 二维坐标系设计如下:左上角为原点O(0,0),往右方向是y轴正向,平面中垂直的另一个方向是x轴正向,如图1。三个读卡器坐标分别为(6.68,0)、(0.4,8.33)、(6.3,8.33)。
[0117] 为了验证该方法及系统的性能,这里进行了一系列的实验。在均采用对数-距离分布模型的基础上,按照均值滤波、中位加权滤波、卡尔曼滤波和粒子滤波四种不同的滤波模型对数据进行预处理,再利用相同的三边定位算法求出移动卡片的坐标。通过计算移动卡片的估计坐标和真实坐标之间的距离,得到定位误差,比较粒子滤波和另外三种滤波模型的性能。
[0118] 在采集数据时,为了充分体现四中不同滤波模型在不同环境下的性能,按照三种情况采集到三组数据。其中第一组为环境噪声较大的数据(实验误差如图2中的位置1、位置6、位置10),即人员在目标节点周围不停走动,增大干扰;第二组为环境噪声较小的数据(实验误差如图2中的位置2、位置5、位置9),即选择实验环境人员较少和终端启动均较少时测得的数据,减少干扰;第三组为正常实验环境下测得的数据。采用这三组不同数据,可以更直接的验证四种滤波模型的定位精度和稳定性。
[0119] 图2和图3均为四种滤波方式10次实验的误差分析图。图2是采用引入了环境衰减因素模型的实验结果,图3是未引入环境衰减因素模型的实验结果。
[0120] 从图2中可以看出:
[0121] 1)稳定性方面,四种滤波模型在不同噪声下的定位稳定性有很大差异,其中均值滤波和中位加权滤波在不同噪声影响下的定位误差波动较明显;卡尔曼滤波定位稳定性次之;粒子滤波定位稳定性最好。
[0122] 2)精度方面,在利用添加人为干扰的第一组数据的定位中,粒子滤波表现出了较高的定位精度,10次定位误差均值达到0.68米左右;由于添加了人为噪声,其余三种滤波模型的定位精度则不是很理想,尤其是在位置6,均值滤波和中位加权滤波的定位精度很差。而在利用干扰较小的数据的定位中,从位置2、位置5、位置9可以看出,四种模型的定位精度均较好。这里表明粒子滤波适应不同噪声的能力优于另外三种滤波模型。
[0123] 结合图2和图3可以发现,无论是从精度还是稳定性上看,动态环境衰减模型的定位性能比一般模型的效果好。由于相同距离不同位置受到的环境噪声有很大差异,添加环境衰减因素能更好的调和不同位置带来的环境噪声差异。如果不添加环境衰减因素或者把环境衰减因素设为定值,从图3可以看出,在某些位置的定位性能较好,移动到其他位置时性能变化很大,也即是不能很好地适应环境的变化。本发明提供的方法引入的环境衰减因素是一个变值,随着目标节点的位置变动而变动,具有很强的灵活性。
[0124] 实施例3
[0125] 本发明提供的方法及系统适用于监狱中,将移动卡片制作成手环戴在重刑犯手上,通过计算机可以随时定位重刑犯的所在位置,也可以知道重刑犯的行动轨迹,通过对移动卡片进行ID编码即可区分重刑犯。
[0126] 综上所述,本发明提供的一种基于动态环境衰减因子的粒子滤波室内定位方法及系统,由激发器发出激发信号给移动卡片,所述移动卡片发出多个接收信号强度数据,通过三个读卡器获取移动卡片发出的接收信号强度数据并对所述接收信号强度数据进行预处理。由于本发明提供的室内定位系统是应用在嘈杂以及时刻变化的动态环境条件,因此结合动态环境衰减模型来计算移动卡片与三个读卡器之间的距离,并利用三边定位算法计算得移动卡片的准确位置,实现能够很好地调和不同位置带来的环境噪声差异,以及在室内定位中有较高的定位精度和较好的稳定性。由于标准粒子滤波算法存在权值退化的现象,即迭代一定次数后,采样粒子只有极少数具有较大权值,其余采样粒子的权值可以忽略不计,造成大量计算浪费在计算权值较小的粒子上,故需要重采样来舍弃权值较小的粒子,以权值较大的粒子进行取代。通过三边定位配合最小二乘法能够有效地提高定位精度,得到移动卡片的精确位置。
[0127] 以上所述仅为本发明的实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等同变换,或直接或间接运用在相关的技术领域,均同理包括在本发明的专利保护范围内。
QQ群二维码
意见反馈