一种检测轨迹偏离的方法与流程

本发明属于网约车是否按导航轨迹行驶，涉及一种检测轨迹偏离的方法。

背景技术：

乘客在打车的时候，手机地图会给出最佳路线，但是在实际行驶中，司机有意或无意的没有按设定好的路线行驶，这时候需要提醒司机和乘客偏移了规划路线。一般对于是否偏离规划路线是通过车辆的gps定位，看定位是否在规划的路线上，但是，gps导航定位包括下列六种误差:.星历误差—予报的卫星位置的误差；.星钟差—予报的卫星钟差,包括sa；电离层误差—由于电离层效应引起的观测值的误差；对流层误差—由于对流层效应引起的观测值的误差；多径误差—由于反射信号进入接收机天线引起的观测值的误差；接收机误差—由于热噪声、软件和各通道之间的偏差引起的观测值误差。定位距离误差至少有15米。但有时由于信号的强弱变化，这个数可能达20－30米了。另外，如果gps接收设备太灵敏，会出现漂移，这种漂移就会更大了，有时会到百米以上。所以行驶车辆定位是否在规划路径上，这种方式，只能作为参考，也无法确定是否偏离轨迹。

技术实现要素：

1、所要解决的技术问题：

现有网约车在行驶过程中是否按照规划路线的判断通过gps定位无法做出正确的判断。

2、技术方案：

为了解决以上问题，一种检测轨迹偏离的方法，包括以下步骤：第一步：实时选取相邻的坐标点a点和b点，和a点和b点直线设为线路l，第二步：计算车辆的实时位置p到线路l的每个线段的最近距离集合，找出集合中的最小值；第三步：将最小值和设定的阈值比较，如果大于设定的阈值，则判定偏离轨迹，如果小于设定的阈值，则判定没有偏离轨迹。计算当前坐标点距离其中一个线段的最短距离的计算方法为：当前点p到ab线上的垂线(1)若在ab线段上，则是当前点到ab线段的最短距离，(2)若在ab线段外，在分别计算p点到a，b点的距离取最小为最短距离；设其中x为经度坐标，y为纬度坐标，ab斜率：斜率：ab直线：直线：解出计算出每条线段的最短距离，找出最短的距离点。

3、有益效果：

本发明提供的检测轨迹偏离的方法能够准确的判断网约车的行驶是否偏离了规划路线。

附图说明

图1为本发明的原理图。

具体实施方式

下面结合附图和实施例来对本发明进行详细说明。

一种检测轨迹偏离的方法，包括以下步骤：第一步：实时选取相邻的坐标点a点和b点，和a点和b点直线设为线路l，第二步：计算车辆的实时位置p到线路l的每个线段的最近距离集合，找出集合中的最小值；第三步：将最小值和设定的阈值比较，如果大于设定的阈值，则判定偏离轨迹，如果小于设定的阈值，则判定没有偏离轨迹。实时检测司机当前坐标点距离这条规划的路线的最短距离，在一定的阈值内，就可以认为司机按规划的路线在行驶，所以给出的解决方案是：路线是坐标点的集合，相邻的二个点的线段的集合，就能绘制出行驶路线，所以只要计算出当前点距离这条行驶路线的每个线段的最短距离集合，找出集合中最小值，再和设定的阈值比较，就能判断结果。

实施例1

设定阈值为20米

打车时给导航会给出设定好的路线，可以得到路线的坐标点集合，在行驶过程中，每隔几秒，计算出当前司机距离该条路线的最短距离点，如果最短距离点大于20米，就可以认为司机没有按规划路线行驶。

实施例2

设定阈值为30米。

打车时给导航会给出设定好的路线，可以得到路线的坐标点集合，在行驶过程中，每隔几秒，计算出当前司机距离该条路线的最短距离点，如图1所示，当连续的p1和p2点的最短距离点大于30米，就可以认为司机没有按规划路线行驶，如果p1点的最短距离大于30米，p2点的最短距离点小于30米，认为司机按规划路线行驶。

虽然本发明已以较佳实施例公开如上，但它们并不是用来限定本发明的，任何熟习此技艺者，在不脱离本发明之精神和范围内，自当可作各种变化或润饰，因此本发明的保护范围应当以本申请的权利要求保护范围所界定的为准。