一种应用于自动驾驶的多车协同建图方法技术

本发明专利技术涉及智能驾驶的技术领域，更具体地，涉及一种应用于自动驾驶的多车协同建图方法。包括以下步骤，步骤1：数据采集与感知；步骤2：点云数据的预处理；步骤3：局部地图与全局地图；步骤4：通信模块；步骤5：车辆之间的匹配；步骤6：匹配成功之后，每辆车发送匹配结果给对方；步骤7：每辆车收到对方持续发过来的全局边缘地图和对方的轨迹数据之后，将数据通过步骤5计算得到的矩阵进行转换，再将结果传输至里程计算和建图部分进行实时的协同建图。

【技术实现步骤摘要】
一种应用于自动驾驶的多车协同建图方法
本专利技术涉及智能驾驶的
，更具体地，涉及一种应用于自动驾驶的多车协同建图方法。
技术介绍
LCM是一组用于消息传递和数据编组的轻量级库和工具可以针对高带宽和低延迟的实时系统，它提供了一个发布/订阅消息传递模型和自动编组，LCM的实现是通过UDP的组播机制，在一定组播地址和频道下进行传输自定义的数据信息。因此，本方法利用其实时性与组播的特性，选择其作为车辆之间协同通信的方法。ROS（RobotOperatingSystem）是一个机器人操作系统。它提供了操作系统应有的服务，包括硬件抽象，底层设备控制，常用函数的实现，进程间消息传递，以及包管理。它也提供用于获取、编译、编写、和跨计算机运行代码所需的工具和库函数。ROS的主要目标是为机器人研究和开发提供代码复用的支持。ROS是一个分布式的进程框架，并将节点作为基本单元。这些进程被封装在易于被分享和发布的程序包和功能包中。ROS也支持一种类似于代码储存库的联合系统，这个系统也可以实现工程的协作及发布。这个设计可以使一个工程的开发和实现从文件系统到用户接口完全独立决策（不受ROS限制）。同时，所有的工程都可以被ROS的基础工具整合在一起。本方法使用的传感器为velodyne的16线激光雷达，ROS平台对velodyne具有比较好的硬件驱动支持以及PCL点云处理的库函数。点云匹配是将两个或两个以上坐标系中的大容量三维空间数据点的集合转换到统一坐标系中的数学计算过程，实际上就是要找出两个坐标系之间的变换关系。这种关系可以用一个旋转矩阵R和平移向量T来描述，点云匹配就是要求解出（R，T）。目前经常使用的点云匹配算法包括：最近点迭代算法（ICP）、RANSAC等。本方法使用ICP点云匹配算法，计算多车匹配协同的坐标系变换关系。目前有的技术主要存在的问题有以下几点：目前大部分的建图技术针对单车的建图；建图方案需要比较多的外设传感器，价格昂贵；单车的建图存在精确度差、速度慢与效率低的问题；已有的协同建图方法需要大量内存空间，计算量大，并且对CPU要求很高；已有的协同建图方法需要占据大量的带宽资源；产生上述缺点的原因是，目前研发重点集中在单车的建图方案，在一辆车上面集中安装多个激光雷达、工业相机以及惯性导航系统等高价格传感器，充分发挥一辆车的建图效果。这种做法虽然能够在最大程度上提高一辆车的探测视野，然而单辆车的多传感器使用具有极限性和局限性，无法在探测范围方面进一步突破。单车建图的过程，随着算法运行累积时间的延长，算法自身的累积误差越来越大，所建的地图精确度降低，并且由于长时间的单车建图，很容易造成系统的不稳定性。已有的多车协同建图基于图特征的方法建图，其算法需要车辆在整个过程中随时随地发送自身的图节点到整个网络，造成网络利用率下降，网络带宽资源紧张的情况。于此同时网络中所有的节点接到对方发送的数据之后，没有经过任何预处理等优化操作，直接进行大量复杂的计算，这一点对于运行算法的CPU成本要求非常高。
技术实现思路
本专利技术为克服上述现有技术所述的至少一种缺陷，提供一种应用于自动驾驶的多车协同建图方法，目的是要设计一种低成本传感器、低网络带宽利用率、低CPU利用率、高灵活性以及高效的协同建图方法。本专利技术的技术方案是：一种应用于自动驾驶的多车协同建图方法，配套系统包括：使用的传感器、使用的笔记本电脑等计算单元以及网络通信环境，其中，其内容具体包括：一台velodyne的16线激光雷达，一套双天线的GPS接收机，一部用于进行差分操作的基站，一台Ubuntu系统的笔记本电脑和一套无线上网卡设备。包括以下步骤：步骤1：数据采集与感知；步骤2：点云数据的预处理；步骤3：局部地图与全局地图；步骤4：通信模块；步骤5：车辆之间的匹配；步骤6：匹配成功之后，每辆车发送匹配结果给对方；步骤7：每辆车收到对方持续发过来的全局边缘地图和对方的轨迹数据之后，将数据通过步骤5计算得到的矩阵进行转换，再将结果传输至里程计算和建图部分进行实时的协同建图。进一步的，所述的步骤1中，通过安装在车顶的激光雷达，以10HZ的频率感知采集数据，以激光雷达点云的形式记录在内存之中；通过安装在车顶的双天线与固定在车内的GPS接收机，以50HZ的频率感知实时的GPS数据存储在内存之中。其中GPS数据是车上的GPS接收机与基站进行了差分之后的结果，提高了GPS的定位精确度，保证获得厘米级别的GPS定位数据。进一步的，所述的步骤2中，将采集得到的点云数据作为输入，将点云按照几何分布特性划分为包含平面点线的平面点云以及只包含轮廓的边缘点云；计算此时这一帧点云与上一帧点云的变换关系，记录下来；里程位姿的计算：将预配准之后的点云作为输入，根据每一帧点云之间的变换关系，计算得到并记录车辆的轨迹路线。进一步的，所述的步骤3中，以出发位置作为原点，车头的前进方向作为y轴建立空间直角坐标系，将步骤2中的分类之后的点云作为输入，计算得到当前时刻的局部点云地图，此局部点云地图是以当前位置为原点得到的地图；根据本车点云帧与帧之间的变换关系，得到以起点为原点的全局点云地图，全局点云地图分为边缘点云地图和平面点云地图，存储所有的全局点云地图。进一步的，所述的步骤4中，通信模块检测当前的智能车是否在通信范围之内：如果在通信范围之内，则发送此时此刻的GPS数据，并接收其他车辆发送的GPS数据；将对方的GPS与自己的GPS进行坐标计算，得到欧式物理距离；当所判断的欧式距离在阈值允许范围之内的时候，从步骤4中获取当前最新的全局平面点云地图，彼此发送给对方。进一步的，所述的步骤5中，每辆车接收到对方最新的全局平面点云地图以及相对应的GPS数据之后，将经度、纬度以及海拔数据转换至平面直角坐标系的形式，将车辆的航向角计算差值，作为匹配算法的预处理矩阵；进入匹配模块，利用预处理矩阵以及本车此时刻的全局平面地图和对方此时刻的全局平面地图进行ICP匹配得到一个匹配结果；如果匹配结果符合匹配的阈值，则认为匹配成功，该匹配的矩阵即为两车的两个坐标系之间的变换矩阵。进一步的，所述的步骤6中，每辆车收到匹配结果之后，即开始发送自己的全局边缘地图和轨迹给对方。该专利技术主要解决的技术问题是：智能驾驶的感知领域，无人车的定位与路径规划需要激光雷达点云电子地图，针对多台无人车在短时间内高效、准确地协同建图。包括：单车建立地图的方法、车辆之间通信的方法以及多车匹配协同的方法。与现有技术相比，有益效果是：多车协同建图，可靠性高：相比于单车的建图，本专利技术创造使用多车同时对目标地区进行建图，能够在某一辆车出现故障的前提下保证其他车辆能够继续工作，具有比较好的鲁棒性和稳健性。本专利技术创造使用多车协同建图，效率高探测视野大：相比于单车建图，本专利技术创造能够在某车辆未能到达目标区域的时候即可完整地得到目标地区的点云地图。相比于在单辆车上面使用更多、价格更高昂的传感器，本专利技术创造能够节省建图与感知设备的成本，并且提高效率。本专利技术创造使用多车协同建图，能够提高精确度：相比于单车建图，本专利技术创造能够利用多车协同的优势降低里程计的累计距离从而降低累积误差，除此之外本专利技术创造还可以通过车辆之间的匹配与数据传输实现车辆各自的误差纠正操作，从而提高建图的精确度。本发本文档来自技高网...

【技术保护点】
1.一种应用于自动驾驶的多车协同建图方法，配套系统包括：使用的传感器、使用的笔记本电脑等计算单元以及网络通信环境，其特征在于，包括以下步骤：步骤1：数据采集与感知；步骤2：点云数据的预处理；步骤3：局部地图与全局地图；步骤4：通信模块；步骤5：车辆之间的匹配；步骤6：匹配成功之后，每辆车发送匹配结果给对方；步骤7：每辆车收到对方持续发过来的全局边缘地图和对方的轨迹数据之后，将数据通过步骤5计算得到的矩阵进行转换，再将结果传输至里程计算和建图部分进行实时的协同建图。

【技术特征摘要】
1.一种应用于自动驾驶的多车协同建图方法，配套系统包括：使用的传感器、使用的笔记本电脑等计算单元以及网络通信环境，其特征在于，包括以下步骤：步骤1：数据采集与感知；步骤2：点云数据的预处理；步骤3：局部地图与全局地图；步骤4：通信模块；步骤5：车辆之间的匹配；步骤6：匹配成功之后，每辆车发送匹配结果给对方；步骤7：每辆车收到对方持续发过来的全局边缘地图和对方的轨迹数据之后，将数据通过步骤5计算得到的矩阵进行转换，再将结果传输至里程计算和建图部分进行实时的协同建图。2.根据权利要求1所述的一种应用于自动驾驶的多车协同建图方法，其特征在于：所述的步骤1中，通过安装在车顶的激光雷达，以10HZ的频率感知采集数据，以激光雷达点云的形式记录在内存之中；通过安装在车顶的双天线与固定在车内的GPS接收机，以50HZ的频率感知实时的GPS数据存储在内存之中。3.根据权利要求1所述的一种应用于自动驾驶的多车协同建图方法，其特征在于：所述的步骤2中，将采集得到的点云数据作为输入，将点云按照几何分布特性划分为包含平面点线的平面点云以及只包含轮廓的边缘点云；计算此时这一帧点云与上一帧点云的变换关系，记录下来；里程位姿的计算：将预配准之后的点云作为输入，根据每一帧点云之间的变换关系，计算得到并记录车辆的轨迹路线。4.根据权利要求1所述的一种应用于自动驾驶的多车协同建图方法，其特征在于：所述的步骤3中，以出发位置作为原点，车头的前进方向作为y轴建立空间直角...

【专利技术属性】
技术研发人员：黄凯，李博洋，轩辕哲，张文权，杨俊杰，朱笛，
申请(专利权)人：中山大学，
类型：发明
国别省市：广东,44