[发明专利]一种基于OBD的北斗/GPS的轨迹优化方法

说明书

本发明公开了一种基于OBD的北斗/GPS的轨迹优化方法，本发明从OBD芯片获取发动机的转速和车速数据，从北斗/GPS芯片获取经纬度和方向角数据，采用漂移过滤算法筛选有效定位数据和漂移数据，并将漂移数据过滤，同时采用轨迹补偿算法将过滤的漂移数据进行补偿还原以维持轨迹的平滑完整。在不用人工参与的情况下实现了车载终端的漂移数据自动过滤和轨迹补偿。

技术领域

本发明属于物联网和车联网领域，具体涉及一种基于OBD的北斗/GPS的轨迹优化方法。

背景技术

近年来随着物联网和车联网行业的快速发展，各种物联网和车联网终端设备在中国发展蔓延，特别是最近这两年，借助于4G通信网络的迅速发展延伸，移动互联网、物联网及车联网也逐渐形成一种融合趋势。随着北斗/GPS定位终端设备的使用日趋广泛，车载定位终端设备的数量也日趋庞大。但由于在城市里使用时，由于建筑物密度较大导致北斗/GPS信号遮挡和反射的情况，在进入地下通道时完全接收不到信号的盲区情况也比较多。会导致定位漂移和无法定位的情况发生，这就需要在这种应用场景进行纠错的一种方法，最大限度减少相关的影响。

目前的定位终端在定位信号纠错补偿的主要手段有以下两种：一是通过基站定位；二是通过道路规划进行轨迹补偿。

目前现有的定位信号纠错补偿技术存在以下缺点：

1、基站定位和通信基站的分布密度相关，定位精度较低，；

2、道路规划的轨迹补偿一般也只能应用于道路密度较低的场景，增加平台的计算压力。

发明内容

本发明的目的在于克服上述不足，提供一种基于OBD的北斗/GPS的轨迹优化方法，在不需要人工参与的情况下，实现实时优化轨迹的功能。

为了达到上述目的，本发明包括以下步骤：

步骤一，采集当前车辆的北斗/GPS数据，通过OBD接口采集当前车辆的发动机转速和车速数据；

步骤二，采用漂移过滤算法过滤北斗/GPS数据中由于信号干扰或衰减产生的漂移定位数据；

步骤三，采用轨迹补偿算法计算出当前定位点的数据；

步骤四，用计算出的定位点的数据代替被过滤的漂移定位数据，整合成优化后的北斗/GPS轨迹。

步骤一中，北斗/GPS数据包括当前车辆的经纬度和方向角数据。

步骤二中，漂移过滤算法的具体方法如下：

每隔固定时间获取一次北斗/GPS数据，并计算本次有效定位点与前次有效定位点的直线距离，以最大速度作为限制条件，计算以最大速度行驶t秒的距离dt米作为阀值，如果前次有效定位点和t秒后的定位点间的直线距离大于阀值，则认为后面这个定位点为漂移误差值，过滤且不统计为有效定位点。

本次有效定位点与前次有效定位点的直线距离的计算公式如下：

d＝s·cos{1/[sinφAsinφB+cosφAcosφBcos(λB-λA)]}

其中，s为车辆速度，本次有效定位点A的经纬度分别为λA和φA，前次有效定位点B的经纬度为λB和φA。

步骤三中，轨迹补偿算法的具体方法如下：

根据OBD接口采集到的当前车辆的速度平均值，以及北斗/GPS采集到的距离上次有效定位点的时间，计算出行驶的距离；

根据上次有效定位点的位置和北斗/GPS的方向角数据，计算并还原出过滤定位点的位置数据，再将该数据补偿到轨迹数据中。

步骤四中，整合是指将还原数据代替被过滤的漂移定位数据补偿到轨迹数据中。