[发明专利]一种基于地图信息的动态粒子滤波的终端定位方法

说明书

本发明公开一种基于地图信息的动态粒子滤波的终端定位方法，针对室内定位技术领域，常用粒子滤波算法难以确定良好的初始粒子数目与分布状态的问题，本发明按照自定义地图格式制作室内定位矢量地图，对不同区域进行实地测量获得最佳参考粒子数目，根据接收到的RSSI数据计算出各个区域粒子分配比例，进一步计算确定最终的粒子数目和粒子分布方案，根据粒子分布方案初始化粒子，通过粒子滤波定位算法获得位置估计，提高了定位精度。

技术领域

本发明涉及室内定位技术领域，具体涉及一种基于地图信息的动态粒子滤波的终端定位方法。

背景技术

室内定位场景下，常用粒子滤波算法融合多维信息提高定位精度，一般分为如下5个步骤：初始化粒子，粒子转移，权重更新，重采样和位置估计，而其中粒子初始化阶段需要解决两个问题，一是粒子数目问题，二是粒子分布问题。

首先粒子数目的多寡对粒子滤波的效果和计算量都有很大影响。通常粒子数越多则对于分布的采样越多，也就更能准确的表示状态空间的分布情况，从而获得良好的定位效果。但是随着粒子数目的增多，其缺点也开始显现，由于每个粒子都会参与状态转移和权值计算，所有粒子越多计算量也就越大。在室内定位场景下，有着对实时定位的要求，因此定位延迟不能过高，并且在粒子数过多的情况下，服务器会花大量时间继续计算，导致得到定位结果的延迟增加。所以在确定粒子数目的时候需要综合考虑其对定位精度和计算效率的影响，才能选择到合理的粒子数目。

同时，对于粒子的分布问题，在初始化阶段粒子通常根据先验知识确定粒子的分布。针对定位场景，在初始化粒子之前需要确定粒子分布区域，然后在该区域放置粒子，粒子分布区域的大小影响最终的定位效果。当区域较大时，例如限定为整层楼的区域，此时粒子的分布非常稀疏，将难以做到全面覆盖，同时又有大量粒子距离真实位置过远，从而导致其计算出的权值过小。在经过一轮滤波后只有少量粒子存活，通过这些粒子计算出的位置估计往往误差很大。当区域较小时，粒子的分布过于紧凑，每个粒子的区分度不够，导致最终的定位效果下降。

因此，不同的粒子数目以及粒子分布对室内定位场景粒子滤波方法的定位精度以及定位延迟均有较大影响，本发明提出的一种基于地图信息的动态粒子滤波的终端定位方法，结合地图信息和信标部署信息，在粒子初始化阶段给出了更为合理的粒子数目和分布方案，提升了整体粒子滤波定位方法的性能。

发明内容

为解决上述背景技术中提出的问题，本发明提供一种基于地图信息的动态粒子滤波的终端定位方法，以在粒子初始化阶段给出更为合理的粒子数目和分布方案，提升整体粒子滤波定位方法的性能。

为实现上述目的，本发明提供如下技术方案：

一种基于地图信息的动态粒子滤波的终端定位方法，包括：

S1：根据建筑图纸绘制具有多个区域的SVG格式的地图；

S2：测试人员持定位终端实地测量，根据地图中不同区域的区域类型、复杂程度和大小，设定每个区域中的参考粒子数目，一个粒子对应定位终端在地图上的一个可行位置；

S3：在实地的每个区域中部署至少一个信标，并在地图上部署与实地的信标数量和位置对应的虚拟信标，定位终端用于接收实地的信标发送的强度指示RSSI，对接收的RSSI进行归一化处理，并根据数值大小对归一化处理后的RSSI计算相对比例，得到RSSI对应的信标所占比例；

S4：根据信标所占比例计算得到的各区域粒子分配比例，根据粒子分配比例计算确定最终的粒子数目和粒子分布方案；

S5：根据最终的粒子数目和粒子分布方案进行粒子初始化；

S6：移动每个粒子的位置，同时地图墙体信息加以辅助，进行粒子碰撞检测；

S7：粒子完成移动后，定位终端再次接收RSSI，并根据再次接收的RSSI对粒子进行权重更新；