目标定位方法及系统的制作方法
【专利摘要】本发明公开了目标定位方法，包括：在目标的活动范围图中生成多个采样点；根据多个采样点的初始电磁场强度及待定位目标的当前电磁场强度，获取待定位目标在多个采样点的条件概率密度；根据条件概率密度对采样点进行重采样更新；根据更新后的采样点的坐标值获取待定位目标的位置。本发明可以解决室内定位受检测环境影响而不能精确定位的问题，从而使得对室内目标的定位或跟踪更准确。
【专利说明】目标定位方法及系统
【技术领域】
[0001] 本发明涉及室内定位、仿真领域，特别涉及目标定位方法及系统。
【背景技术】
[0002] 室内定位技术是一种获取室内的人和物位置信息的技术，以位置信息为基础可为 使用者提供多种服务，在军事和民用领域都有着广阔的应用前景。现有的室内定位方法有 红外线室内定位技术、超声波定位技术、蓝牙技术、射频识别技术和无线传感器网络技术 等。由于上述定位技术的实现均依赖于对各类无线信息的采集，因此，当检测环境的无线信 息干扰较大，情况较复杂时，现有的室内定位方法将无法正常工作，从而影响对待定位目标 的定位。
【发明内容】
[0003] 针对现有技术中的缺陷，本发明一方面提供了目标定位方法。该定位方法通过对 当前电磁场的测量，确定待定位目标处于采样点位置的概率，从而获得待定位目标的当前 位置。从而解决了上述现有技术中，室内定位技术受检测环境影响，不能精确定位的问题。
[0004] 本发明一实施例提供的目标定位方法，包括：
[0005] 在目标活动范围图中生成多个采样点；根据所述多个采样点的初始电磁场强度及 待定位目标的当前电磁场强度，获取待定位目标在所述多个采样点的条件概率密度；根据 所述条件概率密度对所述采样点进行重采样更新；根据所述更新后的采样点坐标值获取待 定位目标位置。
[0006] 在一些实施方式中，所述根据所述多个采样点的初始电磁场强度及待定位目标的 当前电磁场强度，获取待定位目标在所述多个采样点的条件概率密度的步骤包括：根据蒙 特卡罗法动作模型对所述多个采样点的初始坐标进行更新；根据更新后的多个采样点的初 始电磁场强度及当前电磁场强度，通过蒙特卡罗法测量模型获取待定位目标在所述多个采 样点的条件概率密度。
[0007] 在一些实施方式中，所述在目标的活动范围图中生成多个采样点的步骤包括：在 目标活动范围图中，通过随机函数生成多个采样点。
[0008] 在一些实施方式中，所述在目标的活动范围图内生成多个采样点的步骤包括：在 目标活动范围图中，根据历史采样点信息及基本系列算法BSAS生成多个采样点。
[0009] 在一些实施方式中，所述根据历史采样点信息及基本系列算法BSAS生成多个采 样点的步骤包括：建立初始聚群m=l，C m=IxJ ;根据所述任意两个历史采样点间的欧拉距离 d(x⑴，Ckhmin^.^cKx⑴，Cj),设定门限值0 ;根据所述门限值0及参考采样点，依次判 断所述多个历史采样点是否属于所述初始聚群Ck=Ck U {X(i)}，若属于，则加入所述初始聚 群，若不属于，则创建新聚群m=m+l，Cm={x (i)};若所述聚群的采样点数量大于设定聚群粒子 数量，则根据所述设定聚群粒子数量对所述聚群的采样点进行提取；将所述聚群的采样点 确定为多个采样点。
[0010] 在一些实施方式中，所述根据蒙特卡罗法动作模型对所述多个采样点的初始坐标 进行更新的步骤包括：根据蒙特卡罗法动作模型（Xt，yt) (n)=(Xt+ ytJ (n)+?( e (n))更新所述 多个采样点的二维初始坐标。
[0011] 在一些实施方式中，所述根据更新后的多个采样点的初始电磁场强度及当 前电磁场强度，通过蒙特卡罗法测量模型获取待定位目标在所述多个采样点的条件 概率密度的步骤包括：对每一采样点，将当前磁场强度值Zt加入蒙特卡罗法测量模型 获取每一采样点的条件概率值4 =Ma |4) "> 〇
[0012] 在一些实施方式中，所述根据所述条件概率密度对所述采样点进行重采样更新的 步骤包括：根据设定取样次数、所述采样点的条件概率密度，根据随机采用函数对所述采样 点进行重采样更新，获取当前采样点。
[0013] 在一些实施方式中，所述根据所述更新后的采样点坐标值获取待定位目标位置的 步骤包括：根据所述更新后的采样点坐标值及条件概率密度确定目标位置根据更新后的采 样点的二维坐标及对应条件概率密度m，根据公式获取待定位目 标位置。
[0014] 同时，本发明还提供了目标定位系统，包括：
[0015] 采样点生成模块，配置为在目标活动范围图中生成多个采样点；
[0016] 条件概率密度获取模块，配置为根据所述多个采样点的初始电磁场强度及待定位 目标的当前电磁场强度，获取待定位目标在所述多个采样点的条件概率密度；
[0017] 重采样模块，配置为根据所述条件概率密度对所述采样点进行重采样更新；
[0018] 定位模块，配置为根据所述更新后的采样点坐标值获取待定位目标位置。
[0019] 在一些实施方式中，在所述条件概率密度获取模块中，包括：
[0020] 蒙特卡罗法动作模型单元，配置为根据蒙特卡罗法动作模型对所述多个采样点的 初始坐标进行更新；
[0021] 蒙特卡罗法测量模型单元，配置为根据更新后的多个采样点的初始电磁场强度及 当前电磁场强度，通过蒙特卡罗法测量模型获取待定位目标在所述多个采样点的条件概率 密度。
[0022] 在一些实施方式中，所述采样点生成模块中包括：
[0023] 随机生成采样点单元，配置为在目标活动范围图中，通过随机函数生成多个采样 点；或
[0024] 历史采样点更新单元，配置为在目标活动范围图中，根据历史采样点信息及基本 系列算法BSAS生成多个采样点。
[0025] 与现有技术相比本发明的技术方案具有以下优点：本发明避免了复杂的软硬件需 求限制，只要获得平面地图和磁场地图加上普通的电磁传感器便可实现定位。本发明所采 用的蒙特卡罗法模型简单，使用灵活易实现，实时性好，性能稳定性高。通过采用的BSAS聚 类方法能够有效解决蒙特卡罗法有效粒子流失的问题。本发明中方法对计算机硬件要求不 高，节约了系统投入。
【专利附图】
【附图说明】
[0026] 图1为本发明一种实施方式中目标定位方法的步骤示意图；
[0027] 图2为本发明一种实施方式中初始状态的室内磁场示意图；
[0028] 图3为本发明一种实施方式中初始状态的室内平面示意图；
[0029] 图4为本发明一种实施方式中初始生成采样点后的平面示意图；
[0030] 图5为本发明一种实施方式中采样点生成方法的步骤示意图；
[0031] 图6为本发明一种实施方式中采样点在平面图上的移动过程示意图；
[0032] 图7为本发明一种实施方式中采样点未重采样更新时的平面示意图；
[0033] 图8为本发明一种实施方式中采样点已重采样更新时的平面示意图；
[0034] 图9为本发明一种实施方式中电磁场的目标定位系统的组成示意图。
【具体实施方式】
[0035] 下面结合附图对发明作进一步详细的说明。
[0036] 图1为本发明一种实施方式中的电磁场的目标定位方法的步骤示意图。如图1所 示，本发明一实施方式的目标定位方法的步骤为：
[0037] 步骤SlOl :对待定位目标所处的室内进行实地测量，获得室内平面图。在室内中 无待定位目标时，通过磁强计对室内的初始磁场进行检查，获得室内初始磁场地图。图2显 示了本发明一种实施方式中初始状态的室内平面示意图，其中目标"A"为待定位目标，"B" 边界范围为目标"A"的室内活动区域，当目标"A"不在"B"边界范围时，通过磁强计测定 "B"边界范围内的各点磁场，获取"B"边界的初始磁场地图，如图3所示。
[0038] 步骤S102 :在步骤SlOl中所获得的室内平面图(如图2所示)上，均匀生成多个采 样点。根据当前所处的不同目标定位阶段（即初始定位状态或跟踪定位状态)，可以采用下 述不同的方法在室内平面图（即图2)上进行采样点的生成。
[0039] 若当前状态为初始定位状态，即没有可参考的历史采样点时，可利用randO函数 分别在X，y方向生成呈"均匀分布"或其他概率分布类型的随机数组成的采样点矩阵。如 在室内平面图（图3)上随机生成：n个采样点。如图4本发明一种实施方式中初始生成采 样点后的平面示意图所示。
[0040] 考虑到目标跟踪的连续性，若当前状态为跟踪定位状态(跟踪定位状态为，对待定 位目标进行连续定位跟踪的定位状态)，即之前的跟踪步骤(或上一跟踪时段）中已产生历 史采样点，则如图5本发明一种实施方式中采样点生成方法的步骤示意图所示，可采用基 本序列算法BSAS对历史采样点进行初始化更新，包括步骤：
[0041] 步骤S1021:根据设定门限值0对历史采样点进行抽取，建立初始聚群 m=l，Cm= {Xm};如：设定门限值0为2m，现有的历史聚群包括Al、A2、A3、A4四个历史采样 点，其中，Al、A4之间的距离为2m，从而Al、A4组成初始聚群1。
[0042] 步骤S1022 :通过公式d(x⑴，Ck)=minKj^md(x⑴，Cj)依次计算步骤S1021抽取后 的多个历史采样点与初始聚群之间的当前欧拉距离。如在初始聚群中共有AU A2及A3三 个历史采样点，其中，初始聚群1与A2之间的欧拉距离为3m、初始聚群1与A3之间的欧拉 距离为lm。
[0043] 步骤S1023 :判断各历史采样点与初始聚群之间的欧拉距离，是否小于设定门限 值0，若是，贝1J加入初始聚群，若否，贝 1J仓Il建新聚群m=m+l，Cm={x(i)}。如步骤S1022中的例 子，当门限值9为2m时，将Al设定为参考采样点，其中，由于初始聚群1与A3之间的欧拉 距离为lm，因此小于2m的门限值，从而历史采样点A3可列入初始聚群1中。初始聚群1与 A2之间的欧拉距离为3m，大于2m的门限值，从而历史采样点A2不能列入初始聚群中，并另 创建聚群2。
[0044] 步骤S1024:在对所有采样点都进行聚群分类后，若其中某一聚群中的采样点数 大于设定聚群粒子数量n，则从该聚群中选中p个粒子代表该聚群，剩下n-p个粒子进行重 新初始化，该重新初始化过程同初始定位中通过rand函数在室内平面图上随机生成n-p个 均匀分布的采样点。
[0045] 例如：已产生历史采样点聚群(聚群中的历史采样点为80个)。首先，预设定初始 聚群1。获得已知历史采样点聚群的欧拉距离，设定门限值0为为2?3m，也可根据精度 要求设定。之后，根据2?3m的门限值，对于该聚群中的每一个历史采样点进行判断，如， 历史采样点与初始采用点比较为：1m，则在门限值0之内，则归类到初始聚群1中。历史采 样点与初始采用点比较为：4m，则在门限值0之外，则创建新聚群2。依次判断，例如，根据 该历史采样点聚群已创建了 4个聚群，其中，聚群1 (10个采样点)、聚群2 (40个采样点)、 聚群3 (20个采样点)、聚群4 (10个采样点)。其中聚群2中的40个采样点超过了设定值 30,则从该聚群2中选中30个粒子代表该聚群，剩下10个采样点重新进行聚群分类。
[0046] 步骤S1025 :将上述步骤S1024中所确定的所有聚群中的采样点，确定为当前采样 点（多个)。
[0047] 在上述实施方式中，首先获取了粒子收敛程度的信息，然后决定用来代表该区域 粒子的数目，通过从旧的粒子集中选取一定比例的粒子然后进行重新初始化。从而通过上 述方式，可以成功解决有效粒子流失的问题，提高定位成功率。
[0048] 步骤S103 :首先，根据蒙特卡罗法动作模型对步骤S102所生成的80个采样点 的初始坐标进行更新。采用蒙特卡罗法动作模型〇^，以 (11)=〇^，7?)(11)+?(0(11))，其中 w( e(n))表示对于每一个粒子，以任意角度任意速度运动更新粒子状态，得到一组新的 采样值^，即80个采样点的新的位置采样值。如图6,采样点在室内平面图上的移动过程 所示，采样点A通过蒙特卡罗法动作模型，从初始位置11随机移动到12 (图示为初始位置 11的任意随机移动位置中的一个)，通过蒙特卡罗法动作模型进行待定位目标模拟的优势 在于，可对人类行为或机器人运动给予较为真实的仿真模拟，从而使目标定位更为准确。移 动后采样点所对应的概率密度为P (Xt I Zw)，其中，概率密度为p (Xt 111)可基于上一轮迭代 得到的后验概率P (Xh I ZH)，运用一个运动模型p (Xt I Xt+ UtJ给予获得。如对于采样点 31，随机生成当前方向角0，根据公式匕^)(11)=^ 1^_1)(11)+￥(0(11))分别对当前位置义，7 进行相加更新位置。之后，通过磁强计获取室内待定位目标的当前的磁场强度值，即获取测 量值Z\采用测量模型p( Zt|Xt)表示当目标在状态Xt下测量值为Zt的条件概率密度。对 每一个采样点^ ,将测量数据Zt加入测量模型^> l(.^vf产后计算出每个粒子的权 重W I^)，即条件概率密度，条件概率密度代表该采样点在该位置上的概率大小，其 中，可具体采用高斯过程1^^=^ ,W2, 进行运算，其 K^t) ' |iC| ^ 中，h_为初始磁场地图值。如：对于采样点sl，根据其位置坐标可通过磁场地图查找获得 磁场值h_ (x，y)，当前待定位目标的测量值为z，利用如上高斯公式可获得p (z I x，y)，这就 是采样点si当前的权重值。下一时刻，采样点si经过运动模型位置坐标会发生变化，同理 磁场值h_ (x，y)也跟着变化，根据当前待定位目标的测量值z再利用高斯公式求出当前权 重值，根据#> I(.W,)(">)公式，将当前权重值与上一时刻的权重值相乘，得到Sl的权 重值，即条件概率密度。依此迭代下去。
[0049] 步骤S104 :根据设定取样次数、S103中所获得的各采样点的条件概率密度，根 据随机采样函数对各采样点进行重采样，其中，随机采样函数可选用matlab软件中的 randsample ()函数。筛选后获取当前采样点。如，图7所示，共有500个采样点sl-s500， 每个采样点都有对应的归一化后的权重值，采用randsample函数对这500个采样点进行重 采样，每个点的权重值决定该点被抽样的概率，进行500次抽样，权重大的点被抽样的概率 大，重采样结束后，500个采样点的分布将会改变。重采样结果如图8所示。
[0050] 步骤S105 :根据步骤S104中所更新的当前采样点的二维坐标值，可直接确定待定 位目标在室内平面地图上的位置。如图8中所示采样点，可将图示中采用点的密集位置的 中心区域确定为待定位目标位直。
[0051] 另外，也可结合各采样点所对应的条件概率密度m，并结合公式 获取当前的目标的而为坐标。从而使待定位目标的定位更为准 确。
[0052] 由此可知，本发明避免了复杂的软硬件需求限制，只要获得平面地图和磁场地图 加上普通的电磁传感器便可实现定位。本发明所采用的蒙特卡罗法模型简单，灵活易实现， 实时性好，性能较稳定；采用的BSAS聚类方法能够有效解决蒙特卡罗法有效粒子流失的问 题。本发明中方法对计算机硬件要求不高，如遇大数据量地图可用动态地图法对地图进行 动态分割，保证运行时间在可承受范围内。
[0053] 同时，如图9所示，本发明的一种实施方式中还提供了目标定位系统，包括：
[0054] 采样点生成模块201，配置为在目标活动范围图中生成多个采样点。
[0055] 条件概率密度获取模块202,配置为根据多个采样点的初始电磁场强度及待定位 目标的当前电磁场强度，获取待定位目标在多个采样点的条件概率密度。
[0056] 重采样模块203,配置为根据条件概率密度对采样点进行重采样更新。其中，重采 样函数为randsample函数。
[0057] 定位模块204,配置为根据更新后的采样点坐标值获取待定位目标位置。具体包 括：根据更新后的采样点的二维坐标获取待定位目标位置。或根据更新后的采样点的二维 坐标及对应条件概率密度m，根据公式k = 获取待定位目标位置。
[0058] 其中，在条件概率密度获取模块202中，包括：
[0059] 蒙特卡罗法动作模型单元2021，配置为根据蒙特卡罗法动作模型对多个采样点的 初始坐标进行更新。蒙特卡罗法动作模型为（x t，yt) (n)=(Xt+ ytJ (n)+w( e (n))。
[0060] 蒙特卡罗法测量模型单元2022,配置为根据更新后的多个采样点的初始电磁场强 度及待定位目标的当前电磁场强度，通过蒙特卡罗法测量模型获取待定位目标在多个采样 点的条件概率密度。具体步骤为，对每一采样点，将当前磁场强度值Zt加入蒙特卡罗法测 量模型UmP)获取每一采样点的条件概率值4 14) ' 0
[0061] 其中，在采样点生成模块201中包括：
[0062] 随机生成采样点单元2011，配置为在目标活动范围图中，通过随机函数生成多个 采样点；
[0063] 历史采样点更新单元2012,配置为在目标活动范围图中，根据历史采样点信息 及基本系列算法BSAS生成多个采样点。具体步骤为：根据设定门限值0建立初始聚群 m=l，C m={xm};判断历史采样点与初始聚群之间的欧拉距离d(x(i), Ck)=minKj<md(x(i), Cj) 是否小于设定门限值9,若是，则加入初始聚群，若否，则创建新聚群m=m+l，Cm={ X(i)};若聚 群的采样点数量大于设定聚群粒子数量，则根据设定聚群粒子数量对聚群的采样点进行提 取；将聚群的采样点确定为多个采样点。
[0064] 以上所述的仅是本发明的一些实施方式。对于本领域的普通技术人员来说，在不 脱离本发明创造构思的前提下，还可以做出若干变形和改进，这些都属于本发明的保护范 围。
【权利要求】
1. 目标定位方法，其特征在于，包括： 在目标的活动范围图中生成多个采样点； 根据所述多个采样点的初始电磁场强度及待定位目标的当前电磁场强度，获取待定位 目标在所述多个采样点的条件概率密度； 根据所述条件概率密度对所述采样点进行重采样更新； 根据所述更新后的采样点的坐标值获取待定位目标的位置。
2. 根据权利要求1所述的方法，其特征在于，所述根据所述多个采样点的初始电磁场 强度及待定位目标的当前电磁场强度，获取待定位目标在所述多个采样点的条件概率密度 的步骤包括： 根据蒙特卡罗法动作模型对所述多个采样点的初始坐标进行更新； 根据更新后的多个采样点的初始电磁场强度及当前电磁场强度，通过蒙特卡罗法测量 模型获取待定位目标在所述多个采样点的条件概率密度。
3. 根据权利要求1或2所述的方法，其特征在于，在目标的活动范围图中，通过随机函 数生成多个采样点。
4. 根据权利要求1所述的方法，其特征在于，所述在目标的活动范围图内生成多个采 样点的步骤包括： 在目标的活动范围图中，根据历史采样点信息及基本系列算法BSAS生成多个采样点。
5. 根据权利要求4所述的方法，其特征在于，所述根据历史采样点信息及基本系列算 法BSAS生成多个采样点的步骤包括： 根据设定门限值Θ建立初始聚群m=l，Cm=IxJ ; 判断所述历史采样点与所述初始聚群之间的欧拉距离d(x⑴，Ck) =Iiiin1 <md(x(i), Cj) 是否小于所述设定门限值Θ，若是，则加入所述初始聚群，若否，则创建新聚群m=m+l， Cm={x(i)}； 若所述聚群的采样点数量大于设定聚群粒子数量，则根据所述设定聚群粒子数量对所 述聚群的采样点进行提取； 将所述聚群的采样点确定为多个采样点。
6. 根据权利要求2所述的方法，其特征在于，所述根据蒙特卡罗法动作模型对所述多 个采样点的初始坐标进行更新的步骤包括： 根据蒙特卡罗法动作模型（Xt，yt) (n)=(Xt+ ytJ (η)+?( θ ω)更新所述多个采样点的二维 初始坐标。
7. 根据权利要求2所述的方法，其特征在于，所述根据更新后的多个采样点的初始电 磁场强度及当前电磁场强度，通过蒙特卡罗法测量模型获取待定位目标在所述多个采样点 的条件概率密度的步骤包括： 对每一采样点，将当前磁场强度值Zt加入蒙特卡罗法测量模型， 获取每一采样点的条件概率值4 14) 〇
8. 根据权利要求1所述的方法，其特征在于，所述根据所述条件概率密度对所述采样 点进行重采样更新的步骤包括： 根据设定的采样次数、所述采样点的条件概率密度，根据随机采样函数对所述采样点 进行重采样更新，获取当前采样点。
9. 根据权利要求1所述的方法，其特征在于，所述根据所述更新后的采样点坐标值获 取待定位目标位置的步骤包括： 根据更新后的采样点的二维坐标获取待定位目标的位置；或 根据更新后的采样点的二维坐标及对应条件概率密度m，根据公式
获取待定位目标位置。
10. 目标定位系统，其特征在于，包括： 采样点生成模块，配置为在目标的活动范围图中生成多个采样点； 条件概率密度获取模块，配置为根据所述多个采样点的初始电磁场强度及待定位目标 的当前电磁场强度，获取待定位目标在所述多个采样点的条件概率密度； 重采样模块，配置为根据所述条件概率密度对所述采样点进行重采样更新； 定位模块，配置为根据所述更新后的采样点坐标值获取待定位目标位置。
11. 根据权利要求10所述的系统，其特征在于，在所述条件概率密度获取模块中，包 括： 蒙特卡罗法动作模型单元，配置为根据蒙特卡罗法动作模型对所述多个采样点的初始 坐标进行更新； 蒙特卡罗法测量模型单元，配置为根据更新后的多个采样点的初始电磁场强度及当 前电磁场强度，通过蒙特卡罗法测量模型获取待定位目标在所述多个采样点的条件概率密 度。
12. 根据权利要求10所述的系统，其特征在于，所述采样点生成模块中包括： 随机生成采样点单元，配置为在目标的活动范围图中，通过随机函数生成多个采样点； 或 历史采样点更新单元，配置为在目标的活动范围图中，根据历史采样点信息及基本系 列算法BSAS生成多个采样点。
【文档编号】G01V3/08GK104375117SQ201310350209
【公开日】2015年2月25日 申请日期:2013年8月12日 优先权日:2013年8月12日
【发明者】陆晓欢, 王新珩, 贾尚杰 申请人:无锡知谷网络科技有限公司