ROS2自学笔记：Rviz可视化工具

启动rviz

ros2 run rviz2 rviz2

rviz订阅其他节点话题，得到数据，并将数据渲染为图像。在add键里rviz已经提供了许多常见机器人话题

rviz显示相机画面：
首先在gazebo里创建相机模块

<?xml version="1.0"?>
<robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="camera">

    <xacro:macro name="usb_camera" params="prefix:=camera">
        <!-- Create laser reference frame -->
        <link name="${prefix}_link">
            <inertial>
                <mass value="0.1" />
                <origin xyz="0 0 0" />
                <inertia ixx="0.01" ixy="0.0" ixz="0.0"
                         iyy="0.01" iyz="0.0"
                         izz="0.01" />
            </inertial>

            <visual>
                <origin xyz=" 0 0 0 " rpy="0 0 0" />
                <geometry>
                    <box size="0.01 0.04 0.04" />
                </geometry>
                <material name="black"/>
            </visual>

            <collision>
                <origin xyz="0.0 0.0 0.0" rpy="0 0 0" />
                <geometry>
                    <box size="0.01 0.04 0.04" />
                </geometry>
            </collision>
        </link>
        <gazebo reference="${prefix}_link">
            <material>Gazebo/Black</material>
        </gazebo>

        <gazebo reference="${prefix}_link">
            <sensor type="camera" name="camera_node">
                <update_rate>30.0</update_rate>
                <camera name="head">
                    <horizontal_fov>1.3962634</horizontal_fov>
                    <image>
                        <width>1280</width>
                        <height>720</height>
                        <format>R8G8B8</format>
                    </image>
                    <clip>
                        <near>0.02</near>
                        <far>300</far>
                    </clip>
                    <noise>
                        <type>gaussian</type>
                        <mean>0.0</mean>
                        <stddev>0.007</stddev>
                    </noise>
                </camera>
                <plugin name="gazebo_camera" filename="libgazebo_ros_camera.so">
				    <ros>
				        <!-- <namespace>stereo</namespace> -->
				        <remapping>~/image_raw:=image_raw</remapping>
				        <remapping>~/camera_info:=camera_info</remapping>
				    </ros>
				    <camera_name>${
    prefix}</camera_name>
				    <frame_name>${
    prefix}_link</frame_name>
				    <hack_baseline>0.2</hack_baseline>
                </plugin>
            </sensor>
        </gazebo>

    </xacro:macro>
</robot>

1 <xacro:macro name="usb_camera" params="prefix:=camera">
宏定义相机模块，名称usb_camera，参数prefix（用于补全名称）

2

<visual>
   <origin xyz=" 0 0 0 " rpy="0 0 0" />
   <geometry>
       <box size="0.01 0.04 0.04" />
   </geometry>
   <material name="black"/>
</visual>

设置相机外观与位置，盒型，黑色

3 <sensor type="camera" name="camera_node">
核心功能，设置相机属性。sensor标签用于标明传感器，这里类型为camera

4 <update_rate>30.0</update_rate>
更新率30

5 <image> <width>1280</width> <height>720</height> <format>R8G8B8</format> </image>
设置相机画面宽1280，高720，颜色空间类型R8G8B8

6 <clip> <near>0.02</near> <far>300</far> </clip>
相机拍摄距离上限300，下限0.02
7 <noise> <type>gaussian</type> <mean>0.0</mean> <stddev>0.007</stddev> </noise>
真实相机拍摄画面可能出现噪音，这里模拟噪音

8

<plugin name="gazebo_camera" filename="libgazebo_ros_camera.so">
				    <ros>
				        <!-- <namespace>stereo</namespace> -->
				        <remapping>~/image_raw:=image_raw</remapping>
				        <remapping>~/camera_info:=camera_info</remapping>
				    </ros>
				    <camera_name>${
    prefix}</camera_name>
				    <frame_name>${
    prefix}_link</frame_name>
				    <hack_baseline>0.2</hack_baseline>
                </plugin>

调用相机驱动libgazebo_ros_camera.so，可以重定向话题名称改为自己要取的名字

把相机和车身合并

<?xml version="1.0"?>
<robot name="arm" xmlns:xacro="http://www.ros.org/wiki/xacro">

    <xacro:include filename="$(find learning_gazebo)/urdf/mbot_base_gazebo.xacro" />
    <xacro:include filename="$(find learning_gazebo)/urdf/sensors/camera_gazebo.xacro" />

    <xacro:property name="camera_offset_x" value="0.17" />
    <xacro:property name="camera_offset_y" value="0" />
    <xacro:property name="camera_offset_z" value="0.10" />

    <!-- Camera -->
    <joint name="camera_joint" type="fixed">
        <origin xyz="${camera_offset_x} ${camera_offset_y} ${camera_offset_z}" rpy="0 0 0" />
        <parent link="base_link"/>
        <child link="camera_link"/>
    </joint>

    <xacro:usb_camera prefix="camera"/>

    <xacro:mbot_base_gazebo/>

</robot>

1 引入相机和车身的xacro模型

 <xacro:include filename="$(find learning_gazebo)/urdf/mbot_base_gazebo.xacro" />
<xacro:include filename="$(find learning_gazebo)/urdf/sensors/camera_gazebo.xacro" />

2

<xacro:property name="camera_offset_x" value="0.17" />
<xacro:property name="camera_offset_y" value="0" />
<xacro:property name="camera_offset_z" value="0.10" />

设置相机位置

3

<joint name="camera_joint" type="fixed">
        <origin xyz="${camera_offset_x} ${camera_offset_y} ${camera_offset_z}" rpy="0 0 0" />
        <parent link="base_link"/>
        <child link="camera_link"/>
    </joint>

用一个joint连接相机和车身

在rviz里面显示结果
操作：add->image->在topic里选择相机发布的话题名

注：gazebo和rviz区别
gazebo为仿真平台，在没有实体机器人时可以使用gazebo模拟机器人环境
rviz为显示平台，可以显示获得的二维或三维信息，数据来源可以为gazebo也可为其他方式