一种基于RSU检测技术的GPS高精定位方法与流程

本发明涉及定位技术领域，尤其涉及一种基于rsu检测技术的gps高精定位方法。

背景技术：

在v2x(vehicletoeverything，意为车对外界信息的交换)的车路协同应用场景中，路侧单元(roadsideunit，rsu)需要与车载单元(onboardunit，obu)进行实时信息交互。rsu是智能交通的重要设备，也是车路协同应用场景的关键设备之一，它安装在路侧，工作形式如红绿灯等路基设备。在车路协同的应用场景中，rsu主要负责接收车辆的位置和车身状态信息，通过相关数据的计算，对车辆的运动轨迹进行判断，并发送预警信息到obu。常见的应用场景有闯红灯报警，绿波车速引导等。

但目前在rsu与obu协同进行车辆定位的手段仍存在技术缺陷：

1)车辆自身的gps定位精度普遍不高，一般是5～10米，obu上传给rsu的定位信息与真实位置偏差较大；

2)在rsu的传感器系统中，机器视觉只能识别车辆，雷达系统只能测距，检测系统缺乏对车辆gps定位信息判断方法，依赖obu上传的定位信息，导致rsu在进行应用场景计算的时候出现误报或预警不及时的现象，rsu预警准确率较低，影响了车路协同技术的普及和应用。

技术实现要素：

本发明提供一种基于rsu检测技术的gps高精定位方法，解决的技术问题是，在v2x的车路协同应用场景中，现有obu的gps定位精度较低，依赖obu上传的定位信息的rsu的预警准确率较低。

为解决以上技术问题，本发明提供一种基于rsu检测技术的gps高精定位方法，包括步骤：

s1.车载单元根据路侧单元的gps定位信息计算车辆与所述路侧单元之间的第一车距，并反馈到所述路侧单元；

s2.所述路侧单元判断所述第一车距与测得的自身与车辆之间的第二车距是否一致，若是则返回到所述步骤s1，若否则对所述车载单元的gps定位信息进行修正。

进一步地，在所述步骤s1前还包括步骤：

s01.所述车载单元定期将自身检测的gps定位信息和车身状态信息发送到所述路侧单元；

s02.所述路侧单元将自身检测的gps定位信息发送到所述车载单元。

进一步地，所述步骤s2具体包括步骤：

s21.所述路侧单元接收所述车载单元发送而至的所述gps定位信息、所述车身状态信息和所述第一车距；

s22.所述路侧单元判断所述车载单元对应的车辆是否在对应的车道上，若是则进行下一步，若否则返回至上一步；

s23.所述路侧单元检测自身与所述车辆之间的所述第二车距是否与所述第一车距一致，若否则进行下一步，如是则返回至所述步骤s01；

s24.根据所述车载单元上传的所述gps定位信息和所述车身状态信息对所述车载单元的gps定位信息进行修正。

进一步地，所述步骤s23具体包括步骤：

s23-1.提取所述车载单元的gps定位信息中的航向角和所述车身状态信息中的车速；

s23-2.将所述车载单元的gps定位信息中的大地经纬度数据参考椭圆为基准投影在高斯平面坐标系上；

s23-3.根据所述航向角将高斯平面坐标系进行平移，使得平移后的高斯平面坐标系的原点与自定义局部坐标系的原点重合；

s23-4.根据所述车速计算所述自定义局部坐标系的位置；

s23-5.将所述自定义局部坐标系的位置换算回大地经纬数据，得到纠正后大地经纬数据；

s23-6.将所述纠正后大地经纬数据发送到所述车载单元。

进一步地，所述步骤s23-2的运算过程为：

假设大地经纬度数据的经度、纬度表示为l、b，将经纬坐标(l，b)转换为高斯平面坐标(x，y)的公式为：

l0＝6n-3(4)；

其中，x为赤道至纬度的平行圈的子午线弧长，n为卯酉圈曲率半径，l为投影点经度l与该点所处经度带轴子午线经度l0之差；t＝tanb，μ＝e′cosb；e＝0.08181919为第一偏心率，e′＝0.082094438为第二偏心率；n＝round[(l+3)/6]，即四舍五入取整数；η＝0.0033528，为wgs-84椭球扁率。

进一步地，在所述步骤s23-2中，将所述高斯平面坐标系换算为所述自定义局部平面坐标系的转换公式为：

其中，(x，y)为高斯平面坐标系中的坐标值，(x′，y′)为自定义局部平面坐标系的坐标值；为转换参数，即是所述车辆的航向角。

进一步地，在所述步骤s23-4中，所述自定义局部坐标系的位置(x″，y″)的运算过程为：

其中，v′是所述车身状态信息中的车速，t为2倍v2x消息传输时间。

进一步地，所述s23-5具体包括步骤：

s23-51.将所述自定义局部坐标系的位置换算回高斯平面坐标；

s23-52.将所述高斯平面坐标换算回大地经纬数据。

进一步地，在所述s23-51中，将所述自定义局部坐标系的位置(x″，y″)换算回高斯平面坐标(x，y)的转换公式为：

进一步地，在所述步骤s23-52中，基于所述公式(1)～(4)将所述高斯平面坐标(x，y)换算回大地经纬数据(l，b)。

本发明提供的一种基于rsu检测技术的gps高精定位方法，路侧单元rsu将自身测得的与车辆的第二车距，与车载单元obu根据自身的gps定位信息和路侧单元的gps定位信息计算得到的第一车距进行对比，在比对不一致时，基于obu上传的gps定位信息中的航向角和车身状态信息中的车速对该gps定位信息的经纬坐标进行修正，并将修正后的gps定位信息发回obu，可有效提高obu的定位精度，同时依赖obu上传的定位信息的rsu的预警准确率也得到显著提高。

附图说明

图1是本发明实施例提供的一种基于rsu检测技术的gps高精定位方法的步骤流程图；

图2是本发明实施例提供的一种基于rsu检测技术的gps高精定位方法接入电路的工作流程图。

具体实施方式

下面结合附图具体阐明本发明的实施方式，实施例的给出仅仅是为了说明目的，并不能理解为对本发明的限定，包括附图仅供参考和说明使用，不构成对本发明专利保护范围的限制，因为在不脱离本发明精神和范围基础上，可以对本发明进行许多改变。

本发明实施例提供的一种基于rsu检测技术的gps高精定位方法，如图1所示的步骤流程图，包括步骤：

s1.车载单元obu根据路侧单元rsu的gps定位信息计算车辆与所述路侧单元rsu之间的第一车距，并反馈到所述路侧单元rsu；

s2.所述路侧单元rsu判断所述第一车距与测得的自身与车辆之间的第二车距是否一致，若是则返回到所述步骤s1，若否则对所述车载单元obu的gps定位信息进行修正。

在本实施例中，在所述步骤s1前还包括步骤：

s01.所述车载单元obu定期将自身检测的gps定位信息和车身状态信息(包括车辆行驶方向和车速等)发送到所述路侧单元rsu；

s02.所述路侧单元rsu将自身检测的gps定位信息发送到所述车载单元obu。

在本实施例中，所述步骤s2具体包括步骤：

s21.所述路侧单元rsu接收所述车载单元obu发送而至的所述gps定位信息、所述车身状态信息和所述第一车距；

s22.所述路侧单元rsu判断所述车载单元obu对应的车辆是否在对应的车道上(可使用视觉系统)，若是则进行下一步，若否则返回至上一步；

s23.所述路侧单元rsu检测自身与所述车辆之间的所述第二车距(可使用毫米波雷达测得)是否与所述第一车距一致，若否则进行下一步，如是则返回至所述步骤s01；

s24.根据所述车载单元obu上传的所述gps定位信息和所述车身状态信息对所述车载单元obu的gps定位信息进行修正。

参见图2所示的工作流程图，可对应于上述步骤。

更详细地，所述步骤s23具体包括步骤：

s23-1.提取所述车载单元obu的gps定位信息中的航向角和所述车身状态信息中的车速；

s23-2.将所述车载单元obu的gps定位信息中的大地经纬度数据参考椭圆为基准投影在高斯平面坐标系上；

s23-3.根据所述航向角将高斯平面坐标系进行平移，使得平移后的高斯平面坐标系的原点与自定义局部坐标系的原点重合；

s23-4.根据所述车速计算所述自定义局部坐标系的位置；

s23-5.将所述自定义局部坐标系的位置换算回大地经纬数据，得到纠正后大地经纬数据；

s23-6.将所述纠正后大地经纬数据发送到所述车载单元obu。

进一步地，所述步骤s23-2的运算过程为：

假设大地经纬度数据的经度、纬度表示为l、b，将经纬坐标(l，b)转换为高斯平面坐标(x，y)的公式为：

l0＝6n-3(4)；

其中，x为赤道至纬度的平行圈的子午线弧长，n为卯酉圈曲率半径，l为投影点经度l与该点所处经度带轴子午线经度l0之差；t＝tanb，μ＝e′cosb；e＝0.08181919为第一偏心率，e′＝0.082094438为第二偏心率；n＝round[(l+3)/6]，即四舍五入取整数；η＝0.0033528，为wgs-84椭球扁率。

进一步地，在所述步骤s23-2中，将所述高斯平面坐标系换算为所述自定义局部平面坐标系的转换公式为：

其中，(x，y)为高斯平面坐标系中的坐标值，(x′，y′)为自定义局部平面坐标系的坐标值；为转换参数，即是所述车辆的航向角。

进一步地，在所述步骤s23-4中，所述自定义局部坐标系的位置(x″，y″)的运算过程为：

其中，v′是所述车身状态信息中的车速，t为2倍v2x消息传输时间，rsu接收到obu发送的车辆当前的gps经纬度、车速和航向角后进行车辆位置估算，rsu把估算后的gps定位信息发送给obu，因此该时间和大小通常为消息传输时间的2倍。

进一步地，所述s23-5具体包括步骤：

s23-51.将所述自定义局部坐标系的位置换算回高斯平面坐标；

s23-52.将所述高斯平面坐标换算回大地经纬数据。

进一步地，在所述s23-51中，将所述自定义局部坐标系的位置(x″，y″)换算回高斯平面坐标(x，y)的转换公式为：

进一步地，在所述步骤s23-52中，基于所述公式(1)～(4)将所述高斯平面坐标(x，y)换算回大地经纬数据(l，，b)。

本发明实施例提供的一种基于rsu检测技术的gps高精定位方法，路侧单元rsursu将自身测得的与车辆的第二车距，与车载单元obuobu根据自身的gps定位信息与路侧单元rsu的gps定位信息计算得到的第一车距进行对比，在比对不一致时(比如相差超过预设的阈值1m时，阈值可根据实际情况设定)，基于obu上传的gps定位信息中的车速和航向角对该gps定位信息的经纬坐标进行修正，并将修正后的gps定位信息发回obu，可有效提高obu的定位精度，同时依赖obu上传的定位信息的rsu的预警准确率也得到显著提高。

上述实施例为本发明较佳的实施方式，但本发明的实施方式并不受上述实施例的限制，其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化，均应为等效的置换方式，都包含在本发明的保护范围之内。