路侧自动驾驶车辆定位导航系统及单个、多个车辆定位导航方法技术方案

路侧自动驾驶车辆定位导航系统及单个、多个车辆定位导航方法，属于车辆自动驾驶领域。现有的大型建筑物或码头等遮挡物多的地区，利用全球卫星定位（GNSS)和惯性导航技术，存在自动驾驶导航系统信号传输性能差、导航误差大的问题。路侧自动驾驶车辆定位导航系统及单个、多个车辆定位导航方法，导航系统包括一组路侧定位导航单元和一组车载导航单元，一组路侧定位导航单元设置在路边，每两个相邻的路侧定位导航单元之间的产生有效探测区域重叠，每个车载导航单元设置在一辆进行自动驾驶的车辆上，每个路侧定位导航单元与有效探测区域内的各车载导航单元进行通信交互。

Roadside Autopilot Vehicle Location and Navigation System and Single or Multiple Vehicle Location and Navigation Method

【技术实现步骤摘要】
路侧自动驾驶车辆定位导航系统及单个、多个车辆定位导航方法
本专利技术涉及一种自动驾驶导航技术，具体涉及基于路侧方式进行导航的系统和方法。
技术介绍
自动驾驶由于可以节省人力成本，降低事故率，减少油耗等优点，目前各界都在努力推动发展。随着各种车载传感器技术和人工智能技术的发展，自动驾驶技术也日渐趋于商用化。尤其在封闭、半封闭的应用场景，如自动化码头，机场，封闭园区等，自动驾驶技术有希望最先商业落地。车辆的自动驾驶主要通过定位、感知、决策和控制来实现。目前自动驾驶车辆的导航技术多是通过车载各种传感器，如激光雷达、毫米波雷达、摄像头以及GPS等，由于每种传感器有各自适用的场景，采用单一传感器容易失效，造成自动驾驶事故。为了提供自动驾驶的可靠性，现有技术多是采用多传感器融合的方案。车载传感器的导航方式存在信号遮挡的问题，例如在大型建筑物、大型机械附近，GPS信号存在多路径效应，造成导航误差较大。如用车载激光雷达进行定位导航时，在空旷环境时，激光雷达提取不到特征信息，从而也会造成交大定位导航误差。传感器可以安放在车辆上，也可以安放在路侧，若是开放的应用场景，在路侧铺设传感器由于投入巨大而变得不现实，但是在封闭、半封闭场景，在路侧或者道路上铺设传感器是一种可行的方案。如在上海洋山港四期工程投入运营的自动导引车AGV(AutomatedGuidedVehicle)，用于运送集装箱，所采取的方案是在地面埋设大量的磁钉（现有专利申请号201811356784.6），用于AGV的定位和导航，该方案的显著优势是不受天气影响，系统运行可靠稳定，但是也有几个显著的缺点，需预先埋设大量的磁钉，投入成本巨大，另外，需对码头场地进行大规模施工，该方案不适用于老码头的改造。另外现有技术（申请号201610800121.3）采用路侧无线定位导航技术，适用于老码头的改造，可灵活铺设该系统，但是由于码头对方大量金属物体（集装箱），信号吸收以及反射造成的多路径效应，从而造成定位导航较大的误差。
技术实现思路
本专利技术的目的是为了解决现有的大型建筑物或码头等遮挡物多的地区，存在的自动驾驶导航系统信号传输性能差、导航误差大的问题，而提出一种路侧自动驾驶车辆定位导航系统及单个、多个车辆定位导航方法。一种路侧自动驾驶车辆定位导航系统，所述的导航系统包括一组路侧定位导航单元和一组车载导航单元，一组路侧定位导航单元设置在路边，每两个相邻的路侧定位导航单元之间的产生有效探测区域重叠，每个车载导航单元设置在一辆进行自动驾驶的车辆上，每个路侧定位导航单元与有效探测区域内的各车载导航单元进行通信交互。一种路侧自动驾驶车辆定位导航方法，所述的导航方法包括以下步骤：将路侧定位导航单元沿着道路一侧随车道线均匀分布并固定，测量出车道线相对于路侧定位导航单元的路测感知模块的有效视场的区域参数，用于车道线上障碍物筛选；步骤一、通过路侧定位导航模块进行路侧自动驾驶车辆的定位，获取有效探测角度和范围内移动目标的坐标、速度和航向角，并获得目标车辆的车辆尺寸；步骤二、通过路侧定位导航单元的路测感知模块进行路侧感知，获取有效探测角度和范围内移动目标的类型并做跟踪；步骤三、由路侧定位导航单元进行路侧导航；步骤四、基于步骤二和步骤三获得的信息实现接续导航。一种侧自动驾驶多车辆定位导航方法，当有多辆车辆之间按照先后顺序进入路侧设备的有效探测区域，路侧数据处理单元可做多线程处理，对应多个目标车辆进行并行定位和导航计算处理；当其中两辆车辆并行前进时，1号车辆和2号车辆，相对于道路一侧安装的同一个路侧定位导航单元，1号车辆遮挡2号车辆，路侧定位导航单元探测不到2号车辆的点云数据，通过以下2种处理方法进行导航：一是将2号车辆做停车处置，等待两车完全错开，返回到多辆车辆之间按照先后顺序进入路侧设备的有效探测区域的当行方法进行处理；二是在1号车辆上安装一个路侧定位导航单元，用于探测2号车辆的点云数据，做同样的处理，对2号车辆进行定位导航。本专利技术的有益效果为：本专利技术申请提供一种路侧自动驾驶导航的系统、方法，能够解决码头导航过程中信号严重遮挡的问题，具有定位导航精度高的优点。本专利技术能为自动驾驶车辆提供基于路侧的高精度导航。该系统不需大规模改造码头场地，降低改造成本，适用于老码头的改造。另外，本系统铺设灵活，按照路测导航单元规定的有效探测区域安装在路旁即可，比现有改造技术相比降低改造难度。附图说明图1为本专利技术涉及的每个路侧定位导航单元与每个车载导航单元之间进行数据信息交互的原理框图；图2为本专利技术涉及的方法流程图；图3为本专利技术涉及的车辆进行自动驾驶时由路测单元进行路侧导航实现接续导航的示意图；图4为本专利技术涉及的两辆车辆并行前进发生遮挡时的第一种处理方式；图5为本专利技术涉及的两辆车辆并行前进发生遮挡时的第二种处理方式。具体实施方式具体实施方式一：本实施方式的路侧自动驾驶车辆定位导航系统，如图1所示，所述的导航系统包括一组路侧定位导航单元1和一组车载导航单元2，一组路侧定位导航单元1设置在路边，每两个相邻的路侧定位导航单元1之间的有效探测区域重叠，每个车载导航单元2设置在一辆进行自动驾驶的车辆上，每个路侧定位导航单元1与有效探测区域内的各车载导航单元2进行通信交互。具体实施方式二：与具体实施方式一不同的是，本实施方式的路侧自动驾驶车辆定位导航系统，如图1所示，所述的每个路侧定位导航单元1包括路侧通信模块3、路侧定位导航模块4、路侧感知模块5和路侧数据处理模块6，所述的每个车载导航单元2包括车载通信模块7、车载决策模块8和车辆控制模块9；其中，路侧通信模块3，用于实现路侧定位导航单元1与车载导航单元2的车载通信模块7之间的通信交互，发送路侧定位导航单元1的定位信息和感知信息，接收车载导航单元2的信息，实现路侧定位导航单元1和车载导航单元2之间的信息交互；路侧定位导航模块4，用于利用路侧传感器获取有效探测角度和范围内目标车辆的坐标、速度和航向角，并获得目标车辆的车辆尺寸；路侧感知模块5，用于通过路侧传感器获取有效探测角度和范围内目标车辆的类型，并跟踪；路侧数据处理模块6，用于处理获取的数据信息；车载通信模块7，用于接收由路侧定位导航单元1的路侧通信模块3发送的定位信息和感知信息，并将车载导航单元2的车辆身份信息和反馈信息发送给路侧定位导航单元1，实现路侧定位导航单元1和车载导航单元2之间的信息交互；车辆决策模块，用于根据接收到的定位和感知信息，做出相应的驾驶决策（如刹车、减速、加速、变道（改变转弯角度）等）；车辆控制模块9，用于执行车辆决策模块的决策结果。具体实施方式三：与具体实施方式二不同的是，本实施方式的路侧自动驾驶车辆定位导航系统，所述的路侧定位导航单元1还可设置在进行自动驾驶的车辆上，用于在两辆并行车辆发生遮挡现象时，通过遮挡车辆上安装的路侧定位导航单元1探测被遮挡车辆的行驶信息，遮挡车辆能够将被遮挡车辆的定位感知信息发送给被遮挡车辆。具体实施方式四：与具体实施方式三不同的是，本实施方式的路侧自动驾驶车辆定位导航系统，所述的路侧定位导航模块4选用超宽带（UWB）定位技术、激光雷达定位技术或视觉定位技术中的一种。具体实施方式五：与具体实施方式四不同的是，本实施方式的路侧自动驾驶车辆定位导航系统，所述的路侧感知本文档来自技高网...

【技术保护点】
1.一种路侧自动驾驶车辆定位导航系统，其特征在于：所述的导航系统包括一组路侧定位导航单元和一组车载导航单元，一组路侧定位导航单元设置在路边，每两个相邻的路侧定位导航单元之间的产生有效探测区域重叠，每个车载导航单元设置在一辆进行自动驾驶的车辆上，每个路侧定位导航单元与有效探测区域内的各车载导航单元进行通信交互。

【技术特征摘要】
1.一种路侧自动驾驶车辆定位导航系统，其特征在于：所述的导航系统包括一组路侧定位导航单元和一组车载导航单元，一组路侧定位导航单元设置在路边，每两个相邻的路侧定位导航单元之间的产生有效探测区域重叠，每个车载导航单元设置在一辆进行自动驾驶的车辆上，每个路侧定位导航单元与有效探测区域内的各车载导航单元进行通信交互。2.根据权利要求1所述的路侧自动驾驶车辆定位导航系统，其特征在于：所述的每个路侧定位导航单元包括路侧通信模块、路侧定位导航模块、路侧感知模块和路侧数据处理模块，所述的每个车载导航单元包括车载通信模块、车载决策模块和车辆控制模块；其中，路侧通信模块，用于实现路侧定位导航单元与车载导航单元的车载通信模块之间的通信交互，发送路侧定位导航单元的定位信息和感知信息，接收车载导航单元的信息，实现路侧定位导航单元和车载导航单元之间的信息交互；路侧定位导航模块，用于利用路侧传感器获取有效探测角度和范围内目标车辆的坐标、速度和航向角，并获得目标车辆的车辆尺寸；路侧感知模块，用于通过路侧传感器获取有效探测角度和范围内目标车辆的类型，并跟踪；路侧数据处理模块，用于处理获取的数据信息；车载通信模块，用于接收由路侧定位导航单元的路侧通信模块发送的定位信息和感知信息，并将车载导航单元的车辆身份信息和反馈信息发送给路侧定位导航单元，实现路侧定位导航单元和车载导航单元之间的信息交互；车辆决策模块，用于根据接收到的定位和感知信息，做出相应的驾驶决策；车辆控制模块，用于执行车辆决策模块的决策结果。3.根据权利要求2所述的路侧自动驾驶车辆定位导航系统，其特征在于：所述的路侧定位导航单元还设置在进行自动驾驶的车辆上，用于在两辆并行车辆发生遮挡现象时，通过遮挡车辆上安装的路侧定位导航单元探测被遮挡车辆的行驶信息，遮挡车辆能够将被遮挡车辆的定位感知信息发送给被遮挡车辆。4.根据权利要求3所述的路侧自动驾驶车辆定位导航系统，其特征在于：所述的路侧定位导航模块选用超宽带定位技术、激光雷达定位技术或视觉定位技术中的一种。5.根据权利要求4所述的路侧自动驾驶车辆定位导航系统，其特征在于：所述的路侧感知模块选用激光雷达感知技术、视觉感知技术或毫米波感知技术中的一种。6.一种路侧自动驾驶车辆定位导航方法，其特征在于：所述的导航方法包括以下步骤：将路侧定位导航单元沿着道路一侧随车道线均匀分布并固定，测量出车道线相对于路侧定位导航单元的路测感知模块的有效视场的区域参数，用于车道线上障碍物筛选；步骤一、通过路侧定位导航模块进行路侧自动驾驶车辆的定位，获取有效探测角度和范围内移动目标的坐标、速度和航向角，并获得目标车辆的车辆尺寸；步骤二、通过路侧定位导航单元的路测感知模块进行路侧感知，获取有效探测角度和范围内移动目标的类型并做跟踪；步骤三、由路侧定位导航单元进行路侧导航；步骤四、基于步骤二和步骤三获得的信息实现接续导航。7.根据权利要求6所述的路侧自动驾驶车辆定位导航方法，其特征在于：所述的步骤二中，通过路侧定位导航单元的路测感知模块进行路侧感知，获取有效探测角度和范围内移动目标的类型并做跟踪的过程为：采集车道线信息：路侧定位导航单元安装在道路侧面，随车道线的走向固定，通过测量得到车道线相对于路侧感知模块有效视场的区域参数，该区域参数记录于路侧数据处理模块，用于后续定位和导航处理；采集背景点云帧数据：路侧感知模块的激光雷达安装调试完毕，在车道线内无障碍物、无目标车辆时的激光雷达有效视场内，采集激光点云数据，作为背景帧，并将数据作为参数文档加以保存；实时采集激光点云数据：该路侧定位导航单元工作时，目...

【专利技术属性】
技术研发人员：董靖，王亚飞，陶圣，周小科，
申请(专利权)人：深圳数翔科技有限公司，
类型：发明
国别省市：广东,44