【学习笔记】手把手教你使用Autoware标定SICK-2D激光雷达和相机

本文主要是介绍【学习笔记】手把手教你使用Autoware标定SICK-2D激光雷达和相机,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

2019/06/21更新说明:很多小伙伴反应从github上下载的Autoware没有Calibration Toolkit,是作者在github 的新源码和我用的版本不一样了。该教程仅针对2018年11月7日的发布版本


网上Autoware的教程不多,而且都是关于多线的威力登雷达和相机的联合标定。自己摸索使用Autoware标定SICK TIM561单线激光雷达和相机的方法,写一个详细的教程,希望可以抛砖引玉。想要转载的小伙伴,请带个原文地址,撰写不易,Thanks♪(・ω・)ノ~


第一章 Calibration Toolkit简介

Calibration Toolkit工具是城市自主无人驾驶开源软件Autoware的其中一个工具,该工具专注于相机与2D/3D激光雷达的联合标定,可以在标定相机的同时自主计算出从相机坐标系至激光雷达坐标系的变换矩阵,具有操作简单、标定准确度较高的优势。

本文档仅针对Calibration Toolkit中相机与2D激光雷达的联合标定步骤进行说明。

第二章 工具详细使用说明

2.1 前期准备

2.1.1  激光雷达的选型与配置

撰写该文档时使用的激光雷达型号为 SICK tim561 单线激光雷达,如图 1 所示。

                                                                              图  1 SICK tim561 单线激光雷达

将激光雷达与计算机相连,该款雷达首先需使用官方提供的 SOPAS  Engineering  Tool 在Windows 操作系统下配置 IP 地址,本文将激光雷达 IP 地址设置为 192.168.10.153,该 IP 地址仅用于举例说明。

完成激光雷达 IP 地址配置后,切换至 Ubuntu 操作系统,将 SICK 激光雷达的 ROS 驱动程序sick_scan-master 拷贝至 ROS 工作空间(通常为 catkin_ws 文件夹)下的 src 文件夹下,catkin_ws文件夹结构如图 2 所示。

                                                                           图  2 catkin_ws 文件夹结构

此时,进入catkin_ws/src/sick_sacn-master/sick_sacn-master/launch文件夹,找到sick_tim_5xx.launch文件,将该文件内<arg name="hostname" default="192.168.8.100" />参数中的192.168.100修改为设置的激光雷达IP地址,随后保存并关闭文件,本文为192.168.10.153。

返回至catkin_ws文件夹,在文件夹空白处按住Sifht按键后点击鼠标右键选择“在此启动终端”,在终端输入catkin_make进行编译,等到编译完成即可,至此激光雷达配置完毕。

2.1.2  Ubuntu 设置静态 IP

完成上述激光雷达配置后,还需配置 Ubuntu 的静态 IP 地址与激光雷达 IP 地址处于同一网段。Ubuntu 系统设置静态 IP 的步骤为:

使用组合按键 Ctrl+Alt+T 打开终端,在终端输入 ifconfig 查看网卡及 IP 地址,如图 3 所示,其中红色框中显示的为网卡的名称。

                                                                                图  3 ifconfig

再次在该终端输入命令sudo gedit /etc/network/interfaces,此时在interfaces文件中修改auto及iface后的网卡名称与终端中ifconfig显示的网卡名称相同(图4中红色方框所示),设置address中IP地址与激光雷达IP地址处于同一网段,gateway中复制address的IP地址并将最后一位修改为1即可。本文设置address为192.168.10.13,与激光雷达同属192.168.10.X网段,gateway为192.168.10.1。

修改完成后保存并关闭interfaces文件,在终端输入命令sudo /etc/init.d/networking restart重启网络,终端显示ok后,再次输入ifconfig确认IP地址是否已设置生效,IP地址生效后如图5所示。

                                                                                             图  4 interfaces

                                                                                    图  5  静态 IP 设置完成  

此时,测试计算机与激光雷达是否可以通信,在终端输入ping加激光雷达的IP地址,如ping 192.168.10.153,若上述配置过程无误,终端将显示图6所示内容。

                                                                                         图  6 ping 激光雷达

2.1.3  制作标定板

在标定相机时,通常使用黑白棋盘格图像(不含红色、绿色标记),如图7所示。

                                                                                             图  7  标定用棋盘格 

棋盘格规格使用A4纸大小,角点(图7中红色、绿色圆圈标记)数分别为8个及6个,单个棋盘格为0.024mm*0.024mm的正方形。请将打印出的高清A4大小棋盘格粘贴在平整、坚硬的平面上。

2.1.4  数据采集

Calibration toolkit采用读取rosbag中topic的方式进行标定,因此需要将激光雷达数据及相机数据采集为rosbag的格式。

打开一个新的终端,输入roscore启动rosmaster,如图8所示。

                                                                                                         图  8 roscore 

保持运行roscore的终端不要关闭,再打开一个新的终端进入ROS工作空间,输入source ./devel/setup.bash命令,随后输入roslaunch sick_scan sick_tim_5xx.launch命令启动激光雷达,若激光雷达启动成功如图9所示。

                                                                                                图  9  激光雷达启动 

保持运行激光雷达的终端不要关闭,再打开一个新的终端进入ROS工作空间,输入source ./devel/setup.bash命令,随后输入roslaunch usb_cam usb_cam_test.launch命令启动USB摄像头,若USB摄像头启动成功如图10所示。

                                                                                              图  10 USB 摄像头启动 

此时打开一个新的终端,输入命令rostopic list,可以查看当前运行的ROS节点发布的话题,如图11所示。其中运行激光雷达的节点发布的话题为/scan,运行USB摄像头的节点发布的话题为/usb_cam/image_raw。

此时在该终端输入rosrun rviz rviz,启动rviz三维可视化平台,rviz界面如图12所示。其中1区域中显示预在rviz中显示的话题等信息,2区域将显示激光雷达信息。在rviz中,单击左下角Add按钮,将弹出添加话题对话框,单击By topic选项卡,分别选择添加/scan下的laserscan话题及/usb_cam/image_raw下的image话题,如图13所示。添加完毕后,将1区域的Global Opations中的fixed frame修改为laser。修改完成后,rviz中显示相机图像及激光点云,如图14所示。

                                                                                                 图  11 rostopic list 

                                                                                                       图  12 rviz 界面 

                                                                                                      图  13 添加话题 

                                                                                                图  14 rviz 显示图像及点云 

现在我们可以使用ROS提供的rosbag record功能录制rosbag。打开一个新的终端,在终端中进入想要保存rosbag的文件夹,输入命令rosbag recored /scan /usb_cam/image_raw开始录制激光雷达点云及相机画面。录制完成后在当前终端使用按键组合Ctrl+C结束录制,如图15所示。

                                                                                              图  15 rosbag 结束录制 

值得注意的是,录制标定用的rosbag时,应当保证棋盘格以多种位姿(左旋、右旋、俯仰)尽量出现在相机视野的各个方位中,同时保证激光可以一直落在棋盘格上。录制结束后可以在保存rosbag的文件夹下使用rosbag info xx.bag(xx.bag为刚才录制的bag名,如图15中2019-03-06-10-36-09.bag)查看录制的bag详细信息,其中包括bag的大小、时长、包含topic的名称以及各个topic的数量。

至此,关闭以上所有终端,标定的前期准备工作结束。

2.2 相机与雷达联合标定

打开一个新的终端,输入roscore命令启动rosmaster。

打开一个新的终端,进入保存rosbag的文件夹,输入命令rosbag play xx.bag播放刚才录制的rosbag,开始播放后立即按空格键暂停播放,如图16所示。

打开一个新的终端,进入Autoware安装的文件夹下的ros文件夹,输入sudo source ./devel/setup.bash命令,再在该终端输入rosrun calibration_camera_lidar calibration_toolkit启动calibration toolkit。软件启动后首先弹出选择相机话题的对话框,选择/usb_cam/image_raw的话题;随后选择标定类型,我们选择Cmaera—>2DLIDAR的标定方式,如图17所示。

                                                                                                 图  16  播放 rosbag 

选择完毕后,将进入calibration toolkit的主界面,主界面如图18所示。在主界面上方红色方框标注的区域从左到右填入标定板的参数,根据我们使用标定板的参数我们输入0.024、0.024、8、6四个参数。填写完毕后,关闭主界面,再次重复启动calibration toolkit的步骤,使填写参数生效。

 

                                                                图  18 calibration toolkit 主界面

再次启动界面后,首先调整主界面布局,方便我们标定。调整后的界面布局如图19所示。

                                                                                   图  19 calibration toolkit 主界面 

此时找到运行rosbag的终端,单击空格播放rosbag,再次暂停后切换到calibration toolkit主界面,将看见到相机画面显示在1区域及雷达点云显示在2区域,在2区域可以通过滚动鼠标中键放大点云,此时便可以开始相机及点云的标定工作。

标定的步骤为:

                                                                                                               图  20  标定过程 

                                                                                                          图  21  标定结束 

  1. 播放rosbag,当calibration toolkit中出现满意的画面及激光数据时暂停rosbag;

  2. 单击主界面右上角Grab按钮进行捕捉。捕捉后将在3区域显示相机图像的标定画面,4区域将显示该时刻的激光雷达点云;

  3. 确认3区域棋盘格可以检测到的前提下,在4区域使用鼠标中键放大点云;

  4. 在4区域按住鼠标右键不动点击鼠标左键进行框选,选择激光落在标点版上的点云,尽量框选在同一个平面的点;

  5. 对于Grab到的效果不好或重复的相机画面及点云信息,可以单击右上角Remove按钮进行移除;

  6. 重复步骤1~4,Grab的次数越多标定结果越好;

  7. 数据标注完成后,点击右上角Calibrate按钮,进行联合标定,此时工具将进入假死状态,计算结束后工具恢复正常;

  8. 点击右上角project按钮将联合标定后的点云投影在相机图像中,投影后的图像显示在3区域,如图21所示;

  9. 此时可以在3区域检查标定效果,若激光均能落在标定板上且没有超出标定板的激光则证明标定效果较好;

  10. 此时点击左上角的Save按钮对标定进行保存,仅保存标定得到的相机内参矩阵及相机雷达外参矩阵即可,如图22所示,而对于相机、雷达的标定数据不需要保存,单击No即可,如图23所示。

                                                                                           图  22  保存标定结果 

                                                                               图  23  无需保存相机、激光标定数据 

至此激光雷达及相机联合标定结束,得到标定结果yaml文件内容如图24所示,自行选择相关参数使用即可。

                                                                                     图  24  标定结果 yaml 文件内容 

这篇关于【学习笔记】手把手教你使用Autoware标定SICK-2D激光雷达和相机的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/578194

相关文章

SpringBoot线程池配置使用示例详解

《SpringBoot线程池配置使用示例详解》SpringBoot集成@Async注解,支持线程池参数配置(核心数、队列容量、拒绝策略等)及生命周期管理,结合监控与任务装饰器,提升异步处理效率与系统... 目录一、核心特性二、添加依赖三、参数详解四、配置线程池五、应用实践代码说明拒绝策略(Rejected

C++ Log4cpp跨平台日志库的使用小结

《C++Log4cpp跨平台日志库的使用小结》Log4cpp是c++类库,本文详细介绍了C++日志库log4cpp的使用方法,及设置日志输出格式和优先级,具有一定的参考价值,感兴趣的可以了解一下... 目录一、介绍1. log4cpp的日志方式2.设置日志输出的格式3. 设置日志的输出优先级二、Window

Ubuntu如何分配​​未使用的空间

《Ubuntu如何分配​​未使用的空间》Ubuntu磁盘空间不足,实际未分配空间8.2G因LVM卷组名称格式差异(双破折号误写)导致无法扩展,确认正确卷组名后,使用lvextend和resize2fs... 目录1:原因2:操作3:报错5:解决问题:确认卷组名称​6:再次操作7:验证扩展是否成功8:问题已解

Qt使用QSqlDatabase连接MySQL实现增删改查功能

《Qt使用QSqlDatabase连接MySQL实现增删改查功能》这篇文章主要为大家详细介绍了Qt如何使用QSqlDatabase连接MySQL实现增删改查功能,文中的示例代码讲解详细,感兴趣的小伙伴... 目录一、创建数据表二、连接mysql数据库三、封装成一个完整的轻量级 ORM 风格类3.1 表结构

使用Docker构建Python Flask程序的详细教程

《使用Docker构建PythonFlask程序的详细教程》在当今的软件开发领域,容器化技术正变得越来越流行,而Docker无疑是其中的佼佼者,本文我们就来聊聊如何使用Docker构建一个简单的Py... 目录引言一、准备工作二、创建 Flask 应用程序三、创建 dockerfile四、构建 Docker

Python使用vllm处理多模态数据的预处理技巧

《Python使用vllm处理多模态数据的预处理技巧》本文深入探讨了在Python环境下使用vLLM处理多模态数据的预处理技巧,我们将从基础概念出发,详细讲解文本、图像、音频等多模态数据的预处理方法,... 目录1. 背景介绍1.1 目的和范围1.2 预期读者1.3 文档结构概述1.4 术语表1.4.1 核

Python使用pip工具实现包自动更新的多种方法

《Python使用pip工具实现包自动更新的多种方法》本文深入探讨了使用Python的pip工具实现包自动更新的各种方法和技术,我们将从基础概念开始,逐步介绍手动更新方法、自动化脚本编写、结合CI/C... 目录1. 背景介绍1.1 目的和范围1.2 预期读者1.3 文档结构概述1.4 术语表1.4.1 核

Conda与Python venv虚拟环境的区别与使用方法详解

《Conda与Pythonvenv虚拟环境的区别与使用方法详解》随着Python社区的成长,虚拟环境的概念和技术也在不断发展,:本文主要介绍Conda与Pythonvenv虚拟环境的区别与使用... 目录前言一、Conda 与 python venv 的核心区别1. Conda 的特点2. Python v

Spring Boot中WebSocket常用使用方法详解

《SpringBoot中WebSocket常用使用方法详解》本文从WebSocket的基础概念出发,详细介绍了SpringBoot集成WebSocket的步骤,并重点讲解了常用的使用方法,包括简单消... 目录一、WebSocket基础概念1.1 什么是WebSocket1.2 WebSocket与HTTP

C#中Guid类使用小结

《C#中Guid类使用小结》本文主要介绍了C#中Guid类用于生成和操作128位的唯一标识符,用于数据库主键及分布式系统,支持通过NewGuid、Parse等方法生成,感兴趣的可以了解一下... 目录前言一、什么是 Guid二、生成 Guid1. 使用 Guid.NewGuid() 方法2. 从字符串创建