[发明专利]一种实时室内定位数据优化方法

说明书

技术领域

本发明涉及一种实时室内定位数据优化方法，尤其涉及一种当定位结果出现在障碍物区域内时的处理方法。

背景技术

目前人们获取室外位置信息的方式主要是通过全球定位系统(Global Positioning System，GPS)，但由于卫星信号容易受建筑物等阻挡，GPS等卫星定位技术并不适合室内或高楼林立的场合。室内定位技术快速发展，已成为GPS的有力补充。室内定位在医疗卫生、消防救援、军事应用等领域都有广阔的应用前景。

室内定位的主要原理是在室内环境下利用无线传感信号获取信号强度，信号发送时间等信息，再利用这些信息，通过一定的定位算法来取得移动终端的精准位置信息。

而在实时定位过程中，由于室内环境复杂，存在桌子、柜子等障碍物，再加上定位误差的存在，会出现定位到的人员出现在桌子，柜子等区域里的情况，这是不符合现实逻辑的。

针对这种情况，可以采用忽略出现在障碍物区域内的点的办法，但是这种方法会引起定位位置点的缺失，特别是在障碍物分布较密集区域，可能造成连续定位点的缺失，影响定位效果。

发明内容

为了克服现有技术的上述缺点，本发明提供了一种实时室内定位数据优化方法。

本发明解决其技术问题所采用的技术方案是：一种实时室内定位数据优化方法，包括如下步骤：

步骤一、判断定位是否结束：如果否，则进入步骤二，如果是，则进入步骤七；

步骤二、获取当前位置点的位置信息；

步骤三、判断当前位置点是否在障碍物区域内：如果否，则进入步骤六，如果是，则进入步骤四；

步骤四、求出上一位置点和当前位置点的连线与障碍区域多边形的所有交点；

步骤五、对交点进行优化处理，将优化结果作为当前位置点的坐标；

步骤六、将上一位置点的坐标替换为当前位置点的坐标，转步骤一；

步骤七、结束优化。

与现有技术相比，本发明的积极效果是：本发明解决了在实时室内定位过程中，定位结果出现在障碍物区域内的问题，通过求取上一位置点与当前位置点的连线与障碍物区域的交点，用优化后的交点位置代替当前位置，实现了定位结果优化，有效避免了由于定位结果出现在障碍物区域内引起的定位结果缺失，使得定位结果更加符合现实逻辑。

附图说明

本发明将通过例子并参照附图的方式说明，其中：

图1是本发明的算法流程图。

具体实施方式

一种实时室内定位数据优化方法，如图1所示，包括如下步骤：

步骤一、判断定位是否结束：如果否，则进入步骤二，如果是，则进入步骤七；

步骤二、获取当前位置点的位置信息；

步骤三、判断当前位置点是否在障碍物区域内：

采用角度和的算法来判断当前位置点是否位于障碍物区域内，具体方法如下：

(1)将障碍物区域抽象成二维平面内的多边形(以下简称“障碍区域多边形”)；

(2)计算当前位置点与障碍区域多边形所有相邻顶点组成的角的角度和；

(3)判断角度和是否等于360度：

如果否，则判定当前位置点在障碍区域多边形边界上或者障碍区域多边形外部，进入步骤六，如果是，则判定当前位置点在障碍区域多边形内部(不包含边界)，进入步骤四；

步骤四、求出上一位置点和当前位置点的连线与障碍区域多边形的所有交点：

遍历多边形的每一条边，判断当前位置点与上一位置点的连线与该条边是否相交，若相交则求出两条线段的交点：

假设已知线段P1P2和线段Q1Q2，我们可以分三步来求出这两条线段的交点：

(1)进行快速排斥实验：设以线段P1P2为对角线的矩形为R，设以线段Q1Q2为对角线的矩形为T，如果R和T相交，则进行跨立实验；否则，则判定两线段不相交。

如果R和T相交，需同时满足以下四个条件：

1)Math.Min(P1.x,P2.x)≤Math.Max(Q1.x,Q2.x)

2)Math.Min(Q1.x,Q2.x)≤Math.Max(P1.x,P2.x)

3)Math.Min(P1.y,P2.y)≤Math.Max(Q1.y,Q2.y)

4)Math.Min(Q1.y,Q2.y)≤Math.Max(P1.y,P2.y)