编写orb-slam的launch文件

首先,创建一个工作空间

然后在orb_launch文件夹下建立launch文件夹

$ cd ~/catkin_ws/src
$ catkin_create_pkg orb_launch std_msgs rospy roscpp

新建一个orb_slam3.launch文件

内容如下

<launch>
    <!--定义全局参数-->
    <arg name="rgb_image" default="/usb_cam/image_raw"/>
    <arg name="path_to_vacabulary" default="/home/zzz/catkin_ws_orb/src/ORB_SLAM3-master/Vocabulary/ORBvoc.txt"/>
    <arg name="path_to_settings" default="/home/zzz/catkin_ws_orb/src/ORB_SLAM3-master/Examples/ROS/ORB_SLAM3/MyD435i.yaml"/>
    <!--启动摄像头节点(USB相机)-->
    <include file="$(find realsense2_camera)/launch/test.launch"/>

    <!--启动ORB-SLAM3-->
    <node name ="Stereo" pkg="ORB_SLAM3" type="Stereo" 
        args="$(arg path_to_vacabulary) $(arg path_to_settings) false" respawn="true" output="screen">
        <remap from="/camera/image_raw" to="$(arg rgb_image)"/>
    </node>
</launch>

 编译运行

处理报错

提示

RLException: while processing /opt/ros/noetic/share/realsense2_camera/launch/test.launch:
Invalid roslaunch XML syntax: [Errno 2] No such file or directory: '/opt/ros/noetic/share/realsense2_camera/launch/test.launch'
The traceback for the exception was written to the log file

 说明找不到相机文件路径,在环境变量中添加路径

gedit ~/.bashrc 

在最下面加入,把相机的包添加进路径

source /home/zzz/realsense_ws/devel/setup.bash

  成功运行,接下来把rgbd和单目的都写好

RGBD

RGBD出了点错,修改了半天,发现1.参数不能增加那个false  2.RGBD需要修改相机的参数,相机需要提供修正过后的深度图才可以运行。

message_filters::Subscriber rgb_sub(nh, "/camera/color/image_raw", 1);
message_filters::Subscriber depth_sub(nh, "/camera/aligned_depth_to_color/image_raw", 1);
<launch>
    <!--定义全局参数-->
    <arg name="rgb_image" default="/usb_cam/image_raw"/>
    <arg name="path_to_vacabulary" default="/home/zzz/catkin_ws_orb/src/ORB_SLAM3-master/Vocabulary/ORBvoc.txt"/>
    <arg name="path_to_settings" default="/home/zzz/catkin_ws_orb/src/ORB_SLAM3-master/Examples/ROS/ORB_SLAM3/MyD435i.yaml"/>
    <!--启动摄像头节点(USB相机)-->
    <include file="/home/zzz/realsense_ws/src/realsense-ros-ros1-legacy/realsense2_camera/launch/test.launch"/>

    <!--启动ORB-SLAM3-->
    <node name ="RGBD" pkg="ORB_SLAM3" type="RGBD" 
        args="$(arg path_to_vacabulary) $(arg path_to_settings)" respawn="false" output="screen">
        <remap from="/camera/image_raw" to="$(arg rgb_image)"/>
    </node>
</launch>

 运行结果如下

 运行yoloorb

发现launch文件一直报错,最后找到原因应该是

他找不到自己的文件,所以报错, 这里我把他的路径全写上去,可以运行

<launch>
    <!--定义全局参数-->
    <!--相机的rgd和depth图像-->
    <arg name="rgb_image" default="camera/color/image_raw"/>
    <arg name="depth_image" default="/camera/depth/image_rect_raw"/>    
    <arg name="path_to_vacabulary" default="/home/zzz/catkin_ws_test/src/YOLO_ORB_SLAM3/Vocabulary/ORBvoc.txt"/>
    <arg name="path_to_settings" default="/home/zzz/catkin_ws_test/src/YOLO_ORB_SLAM3/MyD435i.yaml"/>
    <!--启动摄像头节点(USB相机)-->
    <include file="/home/zzz/realsense_ws/src/realsense-ros-ros1-legacy/realsense2_camera/launch/test.launch"/>

    <!--启动ORB-SLAM3-->
    <node name ="RGBD" pkg="YOLO_ORB_SLAM3" type="RGBD" 
        args="$(arg path_to_vacabulary) $(arg path_to_settings)" respawn="false" output="screen">
    </node>
</launch>

但是只能在终端里运行 

roslaunch orb_launch yolo_slam3.launch 

使用调试运行还是报错 

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值