环境:
Ubuntu 20.04
ROS2 foxy
OpenCV 4.4.0(4版本以上的应该都可以)
安装orb_slam3 搭建环境参考:
https://mp.csdn.net/mp_blog/creation/editor/129137521
git clone https://github.com/zang09/ORB-SLAM3-STEREO-FIXED.git ORB_SLAM3
cd ORB_SLAM3
chmod +x build.sh
./build.sh
这将在lib文件夹中创建libORB_SLAM3.so,只需要安装到这一步,生成 libORB_SLAM3.so 动态库即可。后面的ros程序安装是ros1的,ros1早晚会被ros2替代的,所以后面的ros程序我们就不在安装了。
安装ros2 foxy版orb_slam3程序:
安装相关的ROS2软件包:
sudo apt install ros-$ROS_DISTRO-message-filters
安装orb_slam3_ros2
mkdir -p colcon_ws/src
cd ~/colcon_ws/src
git clone https://github.com/zang09/ORB_SLAM3_ROS2.git orbslam3_ros2
按自己的目录结构修改CMakeLists.txt 第五行
set(ENV{PYTHONPATH} "/opt/ros/foxy/lib/python3.8/site-packages/")
修改 FindORB_SLAM3.cmake 第八行为自己的ORB_SLAM3路径,比如我的:
set(ORB_SLAM3_ROOT_DIR "~/ORB_SLAM3")
编译:
cd ~/colcon_ws
colcon build --symlink-install --packages-select orbslam3
编译报错找不到sophus/se3.hpp:
cd ~/ORB_SLAM3/Thirdparty/Sophus/build
sudo make install
重新编译直至成功。
安装笔记本摄像头驱动:
sudo apt install ros-foxy-usb-cam //foxy安装摄像头驱动
ros2 run usb_cam usb_cam_node_exe //启动摄像头节点
查看摄像头话题:ros2 topic list
/camera_info
/image_raw
/image_raw/compressed
/image_raw/compressedDepth
/image_raw/theora
/parameter_events
/rosout
摄像头发布话题为 : /image_raw
和程序里面的接收话题不一样,需要修改程序内的接收话题名与摄像头发布话题名一致
修改 monocular-slam-node.cpp
修改好话题后要重新编译。
运行程序:
1. 打开终端开启摄像头节点
ros2 run usb_cam usb_cam_node_exe
2. 重新打开一个终端开启单目orbslam3程序
source ~/colcon_ws/install/local_setup.bash
ros2 run orbslam3 mono ~/ORB_SLAM3/Vocabulary/ORBvoc.txt ~/ORB_SLAM3/Examples/Monocular/RealSense_D435i.yaml
上面命令是ros主程序+ ORBvoc.txt + RealSense_D435i.yaml (摄像头配置文件任意选一个就行)路径需要按自己电脑实际路径修改。
可能我的笔记本配置低,需要等待十几秒才能看到图像
看到图像说明程序正常运行了,如果只是一个黑框出不来图像,移动一下笔记本,跑单目静止画面有时出不来图像。
我们这里的目的是跑通程序,真正要让程序运行好还需要给摄像头做标定。
参考网址:
GitHub - zang09/ORB-SLAM3-STEREO-FIXED: Fixed version of ORB-SLAM3 stereo mode文章来源:https://www.toymoban.com/news/detail-672559.html
GitHub - zang09/ORB_SLAM3_ROS2: ROS2 wrapping package for orbslam3 library文章来源地址https://www.toymoban.com/news/detail-672559.html
到了这里,关于ros2机器人foxy版用笔记本摄像头跑单目orb_slam3的文章就介绍完了。如果您还想了解更多内容,请在右上角搜索TOY模板网以前的文章或继续浏览下面的相关文章,希望大家以后多多支持TOY模板网!