ROS+ORBSLAM2_wylnii+RealsenseD415

1.下載

git clone https://github.com/wylnii/ORBSLAM2_with_pointcloud_map.git
git clone https://github.com/gaoxiang12/ORBSLAM2_with_pointcloud_map.git

mkdir -p orbslam_wylnii_ws/src
cd orbslam_wylnii_ws/src
catkin_init_workspace
cd orbslam_wylnii_ws
catkin_make

echo "source /home/hong/ROS/orbslam_wylnii_ws/devel/setup.bash" >> ~/.bashrc
source ~/.bashrc
cd src/ORBSLAM2_modified
chmod +x build.sh 
./build.sh
chmod +x build_ros.sh
./build_ros.sh

修改ros_rgbd.cc
把rgb_topic和depth_topic訂閱話題修改爲

 "/camera/color/image_raw";
 "/camera/aligned_depth_to_color/image_raw";

修改CmakeLists

set(LIBS
        #${OpenCV_LIBS}
        ${EIGEN3_LIBS}
        ${Pangolin_LIBRARIES}
        ${PCL_LIBRARIES}
        ${PROJECT_SOURCE_DIR}/../../../Thirdparty/DBoW2/lib/libDBoW2.so
        #${PROJECT_SOURCE_DIR}/../../../Thirdparty/g2o/lib/libg2o.so
        ${PROJECT_SOURCE_DIR}/../../../lib/libORB_SLAM2.so
        opencv_core #修改
        opencv_imgproc
        opencv_highgui
        )

chmod +x build_ros.sh
./build_ros.sh

roscore
roslaunch realsense2_camera rs_rgbd.launch
rosrun ORB_SLAM2 RGBD /home/hong/ROS/orbslam_ws/src/ORB_SLAM2-master/Vocabulary/ORBvoc.txt /home/hong/ROS/orbslam_ws/src/ORB_SLAM2-master/Examples/ROS/ORB_SLAM2/d415.yaml
rosrun ORB_SLAM2 RGBD /home/hong/ROS/orbslam_wylnii_ws/src/ORBSLAM2_wylnii/ORB_SLAM2_modified/Vocabulary/ORBvoc.txt /home/hong/ROS/orbslam_wylnii_ws/src/ORBSLAM2_wylnii/ORB_SLAM2_modified/Examples/ROS/ORB_SLAM2/d415.yaml

5.結束運行
rostopic pub /RGBD/cmd std_msgs/String "data: 'stop'"
6.
pcl_viewer result.pcd

7.ORBSLAM_wylnii+mono
修改ros_mono.cc ，把程序裏面的topic改爲 /usb_cam/image_raw

roscore
roslaunch usb_cam usb_cam-test.launch
rosrun ORB_SLAM2 Mono /home/hong/ROS/orbslam_wylnii_ws/src/ORBSLAM2_wylnii/ORB_SLAM2_modified/Vocabulary/ORBvoc.txt /home/hong/ROS/orbslam_wylnii_ws/src/ORBSLAM2_wylnii/ORB_SLAM2_modified/Examples/ROS/ORB_SLAM2/mono.yaml

8.ORBSLAM_pointcloud+D415，同上，做相應修改。

rosrun ORB_SLAM2 RGBD /home/hong/ROS/orbslam_map_ws/src/ORBSLAM2_with_pointcloud_map/ORB_SLAM2_modified/Vocabulary/ORBvoc.txt /home/hong/ROS/orbslam_map_ws/src/ORBSLAM2_with_pointcloud_map/ORB_SLAM2_modified/Examples/ROS/ORB_SLAM2/d415.yaml

參考自：
https://blog.csdn.net/subiluo/article/details/88975979