本文介绍了如何在ORB_SLAM2项目中使用RealSense D435相机作为RGB-D输入源,包括ROS下启动D435相机、ORB_SLAM2订阅Topic、ORB_SLAM2读取realsense-viewer录制的rosbag文件等步骤。。

1. 前言

先前已经编写了 如何用TUM数据集运行ORB_SLAM3以及 如何在ROS模式下运行ORB_SLAM3的博客,ORB_SLAM3是基于ORB_SLAM2的,甚至代码仓库中还有遗留的ORB_SLAM2命名空间namespace没有修正,二者不管是用TUM RGB-D数据集直接运行还是在ROS模式下运行的命令都完全一致。所以,在阅读本文之前,先参考上面给出的两篇博客,安装ORB_SLAM2的依赖库和ROS环境。

注意:若想在ROS模式下运行ORB_SLAM2,则一定要安装OpenCV 3.2.0版本,否则会因为系统中存在多个不同版本的OpenCV从而导致动态库链接错误!

RealSense D435在Ubuntu 18.04中realsense驱动安装的步骤也在 【SLAM】ubuntu 18.04 安装 RealSense D435 相机驱动(ARM64/AMD64)一文里面介绍过了,继续阅读本文之前,需要先把D435的驱动搞定。

测试使用的操作系统为 Ubuntu 18.04 LTS,平台为AMD64。

2. 运行步骤

2.1. 编译ORB_SLAM2

阅读到这里,就默认你已经根据上面给出的参考博客把相关依赖项、ROS环境和realsense驱动都已经安装完毕了,这里给出ORB_SLAM2的编译步骤,和ORB_SLAM3也是如出一辙的。

git clone https://github.com/raulmur/ORB_SLAM2.git

cd ORB_SLAM2
chmod +x build.sh
./build.sh
  • 1.
  • 2.
  • 3.
  • 4.
  • 5.

注意,编译之前需要先修改 build.sh脚本,把所有make -j修改成make -j4,避免make编译的时候无止尽地吃掉所有系统资源,这个在ORB_SLAM3的博客中也提到过。

make命令-j选项后面跟着的数字是编译使用的线程数量,建议改成linux系统cpu线程数量的一半或者2/3,避免吃光所有系统资源。选项-j后面不跟数字的时候,编译项目时会无止尽地吃掉所有系统内存和CPU,直到被操作系统KILL掉,编译失败(在我的测试环境中是这个现象)。

编译完毕普通版本后,再编译ROS版本,同样需要把build_ros.sh脚本里面的make -j改成make -j4。

chmod +x ./build_ros.sh
./build_ros.sh
  • 1.
  • 2.

如果你的依赖项环境一切正常,这两个脚本无需任何额外操作即可编译成功。

2.2. ROS下启动D435相机

参考博客:

使用如下命令安装D435的ROS驱动

sudo apt-get install -y ros-melodic-rgbd-launch \
	ros-melodic-realsense2-camera \
	ros-melodic-realsense2-description
  • 1.
  • 2.
  • 3.

安装完毕驱动后,系统中会多出realsense相机的ROS启动文件,可以使用roscd realsense2_camera命令进入apt安装的ros realsense的工作空间,这里就有各种launch文件。

我们需要的是rs_rgbd.launch这个启动文件,以RGB-D模式启动我们的D435相机。

king@ubuntu:~/slam$ roscd realsense2_camera
king@ubuntu:/opt/ros/melodic/share/realsense2_camera$ ls
cmake  launch  msg  nodelet_plugins.xml  package.xml  rviz  srv
king@ubuntu:/opt/ros/melodic/share/realsense2_camera$ ls launch/
demo_pointcloud.launch      rs_aligned_depth.launch           rs_from_file.launch         rs_t265.launch
demo_t265.launch            rs_camera.launch                  rs_multiple_devices.launch
includes                    rs_d400_and_t265.launch           rs_rgbd.launch
opensource_tracking.launch  rs_d435_camera_with_model.launch  rs_rtabmap.launch