[发明专利]基于惯导的室内路径匹配方法

说明书

技术领域

本发明涉及一种室内定位方法，具体为一种基于惯导的室内路径匹配定位方法。

背景技术

随着移动通信技术的快速发展与智能手机的日益普及，越来越多基于位置信息的

服务进入了实际生活和生产。被广泛应用的全球定位系统(GPS)及蜂窝网定位等技术能在室外环境下实现较高精度的定位，但在室内常常面临无线信号衰减、定位精度下降等问题。

为满足人们对于室内定位的需求，出现了众多室内定位技术，包括WIFI、蓝牙、地磁、可见光、惯导等等，这些技术各有特点，应用环境也不相同。

步行惯性定位是一种用于无基础设施室内定位中的新技术，但累积误差效应限制了它的使用范围。

而现有的蓝牙定位技术，需要在定位区域内布置蓝牙标签，且定位精度跟蓝牙的布置密度成正比，要达到定位精度在3米左右需大量的布置蓝牙，通常3米精度的蓝牙布置密度为50米一个，定位实施成本较高。

为了解决现有技术定位实施成本高的问题，本发明人利用惯导和蓝牙技术进行室内路径的匹配，可以很好的降低实施的成本，同时不影响定位的精度。

发明内容

为了解决现有技术中存在的不足，本发明提供了一种基于惯导的室内路径匹配定位方法，利用已知的路径数据和计步器数据做地图的路径匹配，解决大范围少量部署点下定位导航的问题。

本发明的目的是通过如下的技术方案实现的。

一种基于惯导的室内路径匹配方法，包括：

1）根据输入的路径初始化算法参数；

2）根据距离计算当前位置所在路径以及与路径的夹角；

3）对方向角进行修正，归算到路径方向上；

4）当拐弯并侦测到路径ID变化的时候，根据路径长度和惯导在这段路径上的累计距离更新惯导的比例尺；

5）利用夹角和比例尺纠正步长的方向和大小并加到上次的位置或者拐角上更新位置；

6）输出当前位置。

所述步骤1）中的参数包括计步器步数、方向角差值、比例尺、初始定位点、道路信息。

所述步骤2）中如果距离小于8米且夹角小于45度，则判断在当前路径上，否则认为道路发生变化。

判断当前不在路径上，则利用平均夹角估算方向，纠正每步的步长和方向。

在当前路径时，则实时更新平均夹角值和当前方向，累加步长的dx和dy，计算路径和路径方向上的累计步长。

如果路径ID改变则计算拐角位置，并将垂直道路方向的剩下的dx和dy加到累计步长上，计算路径上和路径方向上的累计步长，更新惯导比例尺，纠正每步的步长和方向，更新位置信息，得出当前的位置。

将惯导步长累加修正到蓝牙定位结果上，可以显著的降低蓝牙标签布置的密度，降低实施成本，同时不降低定位的精度，有利用室内定位实施的推广应用。

附图说明

下面结合附图及实施例对本发明进一步进行说明和描述

图1为本发明路径匹配的流程图；

图2为本发明一实施例场景中惯导步长计算结果图；

图3为图2实施例场景中将惯导步长累加到蓝牙定位场景效果图。

图3中：A-计步器结果，B-匹配结果，C-预设路径。

具体实施方式

如图1所示，一种基于惯导的室内路径匹配方法，包括：

1）根据输入的路径初始化算法参数；

2）根据距离计算当前位置所在路径以及与路径的夹角；

3）对方向角进行修正，归算到路径方向上；

4）当拐弯并侦测到路径ID变化的时候，根据路径长度和惯导在这段路径上的累计距离更新惯导的比例尺；

5）利用夹角和比例尺纠正步长的方向和大小并加到上次的位置或拐角上更新位置；

6）输出当前位置。

所述步骤1）中的参数包括计步器步数、方向角差值、比例尺、初始定位点、道路信息。

所述步骤2）根据距离计算当前位置所在路径以及与路径的夹角；计算与道路的距离和夹角，用来判断是否在当前路径上，如果距离小于8米且夹角小于45度，则判断在当前路径上，否则认为道路发生变化。

判断当前不在路径上，则利用平均夹角估算方向，纠正每步的步长和方向。

在当前路径时，则实时更新平均夹角值和当前方向，累加步长的dx和dy，计算路径和路径方向上的累计步长。