[发明专利]一种车辆导航位置偏移判定方法

权利要求书

1.一种车辆导航位置偏移判定方法，其特征为包含以下几个步骤：

步骤A：对地图进行分区建立若干个区块，然后对每个区块设置GeoHash值，各个区块的GeoHash值组成预设路线数据库，对预设路线数据库构建哈希索引，进入步骤B；

步骤B：将预设路线反应到地图上，预设路线由至少一条线段AB组成，线段AB包括端点A和端点B，以每条线段AB为直径画外接圆并获得每条线段AB外接圆圆心的GeoHash值，然后获得车辆实时位置P点的GeoHash值，以P点坐标为圆心并以Rmax为半径画圆Q，其中Rmax比最长线段AB的一半长，遍历圆Q范围内每个分区的GeoHash值的并把这些值与所有线段AB的外接圆圆心的GeoHash值进行匹配：

如果双方没有匹配的值，则输出第二结果同时进入步骤D；

如果有匹配的GeoHash值，则找出所有匹配的GeoHash值对应的线段AB同时进入步骤C；

步骤C：计算P点到所有匹配线段AB的最短距离|Pab|min：

其中P在线段AB上时则|Pab|min＝0；

如果PAB是钝角三角形且P在AB延长线上则|Pab|min＝|PB|；

如果PAB是钝角三角形且P在BA延长线上则|Pab|min＝|PA|；

如果P到所有匹配线段AB的距离|Pab|min≤阀值，则输出第一结果，如果任一或多个|Pab|min＞阀值，则输出第二结果；并进入步骤D；

步骤D：获取前一时刻的输出结果，进入步骤E；

步骤E：比较前一时刻的输出结果与当前的输出结果：

如果前一时刻的输出结果为第一结果，当前的输出结果为第一结果，则判定为没有偏离路线；

如果前一时刻的输出结果为第一结果，当前的输出结果为第二结果，则保留当前的输出结果，等待下一时刻的判定；

如果前一时刻的输出结果为第二结果，当前的输出结果为第一结果，则保留当前的输出结果，等待下一时刻的判定；

如果前一时刻的输出结果为第二结果，当前的输出结果为第一结果，则判断为偏离路线。

2.如权利要求1所述的一种车辆导航位置偏移判定方法，其特征在于，在所述的步骤A中，对正方形地图进行连续的十字均分，直到最小区块所映射的实际面积不大于15M*15M，在进行十字均分的同时对均分的区块进行GeoHash赋值，每进行一次十字均分就赋值一次，赋值的规则为新区块先继承上级区块的GeoHash值然后分别对每一新区块进行GeoHash赋值得到不同的GeoHash值。

3.如权利要求1所述的一种车辆导航位置偏移判定方法，其特征在于，在所述的步骤B中，Rmax大于1/2的最长线段AB的长度，小于等于3/4的最长线段AB的长度。

4.如权利要求1所述的一种车辆导航位置偏移判定方法，其特征在于，在所述的步骤E中，当前时刻和前一时刻的间隔为0.1S。

5.如权利要求1所述的一种车辆导航位置偏移判定方法，其特征在于，所述步骤B中，还包括分别以线段AB的两个端点为圆心，以Rmin为半径画圆，遍历圆Q范围内每个分区的GeoHash值的并把这些值与以线段AB的端点形成的圆匹配：

如果双方没有匹配的值，则输出第二结果同时进入步骤D；

如果有匹配的GeoHash值，则找出所有匹配的GeoHash值对应的线段AB同时进入步骤C。

6.如权利要求5所述的一种车辆导航位置偏移判定方法，其特征在于，所述的Rmin等于1/2的Rmax。

7.如权利要求1所述的一种车辆导航位置偏移判定方法，其特征在于，步骤E中，还包括，如果连续的预设次数内，输出的判断结果均为没有偏离路线，那么增加当前时刻和前一时刻的间隔时间。

8.如权利要求1所述的一种车辆导航位置偏移判定方法，其特征在于，步骤E中，还包括，如果连续的预设次数内，没有输出判断结果，那么输出结果为偏离航线。