ROS2 URDF机器人建模：从入门到避坑指南

在 ROS2 的机器人开发中，URDF (Unified Robot Description Format) 文件扮演着至关重要的角色。它不仅定义了机器人的物理结构，包括连杆、关节、以及它们之间的连接关系，还是 Gazebo 等仿真环境理解机器人模型的关键。很多初学者在使用 ROS2 构建机器人模型时，都会遇到各种各样的问题，例如模型显示不完整、关节运动异常、仿真环境崩溃等等。本文将深入探讨 ROS2 中 URDF 机器人的建模方法，并分享一些实战中的避坑经验。

URDF 的基本结构

一个 URDF 文件本质上是一个 XML 文件，其根元素是 <robot>。在 <robot> 元素下，主要包含两种类型的子元素：<link>（连杆）和 <joint>（关节）。

• <link>: 代表机器人身体的一部分，例如一个轮子、一个支架或者一个摄像头。每个 <link> 元素都需要定义其几何形状 (<geometry>)、惯性属性 (<inertial>) 以及视觉效果 (<visual>) 和碰撞属性 (<collision>).
• <joint>: 定义了两个连杆之间的连接关系以及运动方式。每个 <joint> 元素都需要指定其父连杆 (<parent>)、子连杆 (<child>)、关节类型 (<type>) 以及运动轴线 (<axis>). 常见的关节类型包括：revolute（旋转关节）、prismatic（滑动关节）、fixed（固定关节）等。

创建你的第一个 URDF 模型

让我们从一个简单的例子开始，创建一个只有两个连杆和一个旋转关节的 URDF 模型。首先，创建一个名为 my_robot.urdf 的文件，并添加以下内容：

<?xml version="1.0" ?>
<robot name="my_robot">
  <!-- 定义 base_link -->
  <link name="base_link">
    <visual>
      <geometry>
        <box size="0.2 0.2 0.1"/>
      </geometry>
      <material name="blue">
        <color rgba="0 0 0.8 1"/>
      </material>
    </visual>
    <collision>
      <geometry>
        <box size="0.2 0.2 0.1"/>
      </geometry>
    </collision>
    <inertial>
      <mass value="1"/>
      <inertia ixx="0.0083" iyy="0.0083" izz="0.00083" ixy="0" ixz="0" iyz="0"/>
    </inertial>
  </link>

  <!-- 定义 link1 -->
  <link name="link1">
    <visual>
      <geometry>
        <cylinder length="0.2" radius="0.05"/>
      </geometry>
      <material name="red">
        <color rgba="0.8 0 0 1"/>
      </material>
    </visual>
    <collision>
      <geometry>
        <cylinder length="0.2" radius="0.05"/>
      </geometry>
    </collision>
    <inertial>
      <mass value="0.5"/>
      <inertia ixx="0.001" iyy="0.001" izz="0.000625" ixy="0" ixz="0" iyz="0"/>
    </inertial>
  </link>

  <!-- 定义 joint1，连接 base_link 和 link1 -->
  <joint name="joint1" type="revolute">
    <parent link="base_link"/>
    <child link="link1"/>
    <origin xyz="0 0 0.15" rpy="0 0 0"/>
    <axis xyz="0 1 0"/>
    <limit lower="-3.14" upper="3.14" effort="100" velocity="100"/>
  </joint>
</robot>

在这个例子中，base_link 是一个蓝色的立方体，link1 是一个红色的圆柱体。它们通过一个旋转关节 joint1 连接在一起，joint1 的旋转轴是 Y 轴。origin 标签定义了子连杆相对于父连杆的位姿，rpy 定义了 Roll, Pitch, Yaw 三个方向的旋转角度。

使用 ROS2 验证 URDF 模型

创建好 URDF 文件后，可以使用 ROS2 提供的工具来验证模型是否正确。首先，确保已经安装了 joint_state_publisher 和 robot_state_publisher 这两个 ROS2 包：

sudo apt update
sudo apt install ros-{ros_distro}-joint-state-publisher ros-{ros_distro}-robot-state-publisher

其中 {ros_distro} 需要替换为你使用的 ROS2 发行版名称，例如 foxy 或 galactic。

然后，创建一个 ROS2 启动文件（launch file），例如 view_robot.launch.py，并添加以下内容：

import launch
from launch.actions import DeclareLaunchArgument
from launch.substitutions import Command, LaunchConfiguration
from launch_ros.actions import Node
from launch_ros.parameter_descriptions import ParameterValue
import os

def generate_launch_description():
    pkg_name = 'your_package_name'  # 替换成你的 ROS2 包名
    urdf_name = 'my_robot.urdf' # 替换成你的 urdf 文件名

    robot_description_content = Command(
        ['xacro', ' ', os.path.join(os.path.dirname(__file__), 'urdf', urdf_name)]
    )
    robot_description = {
        'robot_description': ParameterValue(robot_description_content, value_type=str)
    }

    return launch.LaunchDescription([
        DeclareLaunchArgument(
            name='gui',
            default_value='True',
            description='Flag to enable joint_state_publisher_gui'  # 增加描述
        ),
        Node(
            package='robot_state_publisher',
            executable='robot_state_publisher',
            output='screen',
            parameters=[robot_description]
        ),
        Node(
            package='joint_state_publisher',
            executable='joint_state_publisher',
            name='joint_state_publisher',
            condition=launch.condition.UnlessCondition(LaunchConfiguration('gui'))
        ),
        Node(
            package='joint_state_publisher_gui',
            executable='joint_state_publisher_gui',
            name='joint_state_publisher_gui',
            condition=launch.condition.IfCondition(LaunchConfiguration('gui'))
        ),
        Node(
            package='rviz2',
            executable='rviz2',
            name='rviz2',
            output='screen',
            arguments=['-d', os.path.join(os.path.dirname(__file__), 'config', 'rviz_config.rviz')],
        )
    ])

请确保将 your_package_name 替换成你实际的 ROS2 包名，并将 my_robot.urdf 替换成你 URDF 文件的名称。同时，需要创建一个 rviz 配置文件 rviz_config.rviz，并设置 RobotModel 的 Description Source 为 robot_description。

最后，使用以下命令运行启动文件：

ros2 launch your_package_name view_robot.launch.py

如果一切正常，Rviz 应该会显示你的机器人模型。你可以使用 joint_state_publisher_gui 工具来控制关节的运动。

实战避坑经验总结

• 惯性属性的重要性: 在仿真环境中，机器人的惯性属性 (<inertial>) 对其运动行为有着重要的影响。如果惯性属性设置不正确，可能会导致机器人运动不稳定甚至无法运动。建议使用 CAD 软件计算出准确的惯性属性，并将其添加到 URDF 文件中。
• 碰撞属性的优化: 碰撞属性 (<collision>) 用于检测机器人与其他物体之间的碰撞。为了提高仿真效率，可以简化碰撞模型的几何形状。例如，可以使用简单的立方体或者球体来代替复杂的网格模型。
• URDF 的模块化: 对于复杂的机器人模型，可以将 URDF 文件分解成多个小的 URDF 文件，然后使用 <xacro:include> 标签将其组合在一起。这样可以提高 URDF 文件的可读性和可维护性。
• 避免使用绝对路径: 在 URDF 文件中，尽量避免使用绝对路径来引用网格模型或者其他资源文件。可以使用 ROS2 的包路径来引用这些资源，例如 package://your_package_name/meshes/my_mesh.stl。

掌握了这些技巧，相信你就能轻松应对 ROS2 中 URDF 机器人建模的挑战，构建出功能强大的机器人模型。