[发明专利]一种基于rviz实现多激光雷达点云对齐的高效静态标定方法

说明书

本发明公开了一种基于rviz实现多激光雷达点云对齐的高效静态标定方法，步骤如下：量测出各激光雷达相对车身坐标系的相对位置；将三个标定长方体，放置在车身坐标系中的坐标下，形成三角之势；然后编写一个话题发布程序，按照三个物体实际形状和放置位置画出它们在车身坐标系中的位置，启动话题发布程序和rviz，rviz监听多路激光雷达的点云和物体的话题，在三维视图中观察点云成像和所画的物体位置的差异；编写一个参数标定配置文件，包含六个参数，分别表示平移向量的三个参数和滚转角、俯仰角以及偏航角；通过修改三个角度值，观察点云成像移动趋势，直到调节到与rviz中画出的三个参照物重合即可；最后再微调一下平移向量的数值即可，整个标定过程完成。

技术领域：

本发明涉及一种基于rviz实现多激光雷达点云对齐的高效静态标定方法，其属于电动汽车智能驾驶技术领域。

背景技术：

自动驾驶感知中多传感器融合成了无人驾驶领域的趋势，多传感器信息融合(Multi-sensor Information Fusion,MSIF)，就是利用计算机技术将来自多传感器或多源的信息和数据，在一定的准则下加以自动分析和综合，以完成所需要的决策和估计而进行的信息处理过程。然而在进行上诉步骤之前，对于多路激光雷达来讲，每一个激光雷达在安装过程中，由于机械结构安装精度问题，难免会俯仰偏转滚转等角度偏移现象，另外不同的激光雷达安装位置也不相同，所有这些因素决定必须将每一路雷达的自身坐标系同步到车身坐标系上，以满足不同的激光雷达点云对于同一物体的识别是唯一确定的；如果这一步没有完成，将会导致对于同一障碍物，多路激光雷达会将其识别成多个物体，进而导致后续融合决策出现误导判断，造成不可估量的后果。目前多路激光雷达尤其是不同品牌的产品在使用过程中，难以标定的问题尤为突出，往往需要多家厂商的技术人员联合标定，而且目前大多数激光雷达厂商提供标定都是有偿的，整个标定下来费时费力费钱。

因此，确有必要对现有技术进行改进以解决现有技术之不足。

发明内容：

本发明是为了解决上述现有技术存在的问题而提供一种基于rviz实现多激光雷达点云对齐的高效静态标定方法，其能够解决多路激光雷达作为智能驾驶车辆的传感器时，对于各雷达自身坐标系同步到车身坐标系，从而实现激光雷达点云在原始数据上的对齐操作。

本发明所采用的技术方案有：一种基于rviz实现多激光雷达点云对齐的高效静态标定方法，步骤如下：

第一步：量测出各激光雷达相对车身坐标系的相对位置即平移向量[x_a,y_a,z_a]^T；

第二步：将三个标定长方体其中长20cm、宽20cm、高200cm，分别放置在车身坐标系中的(20m,5m,0m)、(30m,0m,0m)、(20m,-5m,0m)坐标下，上述坐标分别与车身坐标系中(x,y,z)对应，形成三角之势；

第三步：然后编写一个话题发布程序，按照三个物体的实际形状和放置位置画出它们在车身坐标系中的位置，启动话题发布程序和rviz，rviz监听多路激光雷达的点云和物体的话题，在三维视图中观察点云成像和所画的物体位置的差异，编写一个参数标定配置文件，包含六个参数，分别为x、y、z、roll、pitch、yaw，这六个参数分别表示平移向量的三个参数和滚转角、俯仰角以及偏航角；

第四步：通过修改滚转角、俯仰角以及偏航角的角度值，观察点云成像移动趋势，直到调节到与rviz中画出的三个参照物重合即可；

第五步：最后再微调一下平移向量的数值，即满足第四步中三个物体的点云成像与rviz中画出的三个参照物重合，并且任意其他物体在三个激光雷达共同覆盖区域内所形成的点云移动或者静止时完全重合一致，整个标定过程完成。