机器人 / 系统课时

检查 URDF 关节轴与运动限位

检查 URDF 关节轴与运动限位

MoveIt 2 的运动规划依赖 URDF 中正确的关节连接、转动方向与行程边界。这里用一份双关节机械臂模型,检查 link、joint、origin、axis 和 limit,再通过解析命令与姿态测试确认配置是否可信。

学习目标

  • 根据 parent、child 和 origin 还原关节连接及零位关系。
  • 在关节局部坐标系中判断运动轴正方向,并核对位置、速度和力矩限位。
  • 使用 check_urdf 发现结构错误,区分解析通过与运动正确。

从父子连杆读连接关系

link 表示刚体,joint 连接一个父连杆和一个子连杆。URDF 是以根连杆为起点的树形结构:每个非根连杆只能有一个父关节,不适合直接表示闭环机构。读模型时先从 base_link 出发,逐个检查关节所指的 parent 和 child 是否存在,名称是否拼写一致。

<origin xyz="0.30 0 0" rpy="0 0 0"/> 放在 joint 内时,表示关节零位坐标系相对父连杆坐标系平移 0.30 m、无旋转;xyz 单位为米,rpy 以弧度表示滚转、俯仰、偏航。它不同于 visual、collision 中用于摆放几何体的 origin。混用这两种偏移会造成模型外观正常、运动枢轴却错误。

对照实例检查运动轴

将下列完整 URDF 保存为 /tmp/demo_arm.urdf。这里只保留运动学信息,便于独立检查;它没有 visual 和 collision 几何体,尚不能作为完整的 MoveIt 避障模型。

xml
<?xml version="1.0"?>
<robot name="demo_arm">
  <link name="base_link"/>
  <link name="upper_arm_link"/>
  <link name="forearm_link"/>
  <!-- 肩关节位于底座上方 0.20 m -->
  <joint name="shoulder_joint" type="revolute">
    <parent link="base_link"/>
    <child link="upper_arm_link"/>
    <origin xyz="0 0 0.20" rpy="0 0 0"/>
    <axis xyz="0 0 1"/>
    <limit lower="-1.57" upper="1.57" effort="20" velocity="1.0"/>
  </joint>
  <!-- 肘关节沿上臂局部 X 方向偏移 0.30 m -->
  <joint name="elbow_joint" type="revolute">
    <parent link="upper_arm_link"/>
    <child link="forearm_link"/>
    <origin xyz="0.30 0 0" rpy="0 0 0"/>
    <axis xyz="0 1 0"/>
    <limit lower="-1.20" upper="1.20" effort="12" velocity="1.5"/>
  </joint>
</robot>

shoulder_joint 沿自身的 Z 轴旋转,elbow_joint 沿自身的 Y 轴旋转。axis 是关节坐标系内的方向向量,并非世界坐标系中的固定方向;若 origin rpy 改变,运动轴在父连杆坐标系中的朝向也会改变。正角度遵循右手定则,不能只凭屏幕上看似顺时针或逆时针判断。建议总是显式写出单位长度的 axis,避免依赖未填写时默认的 (1,0,0)。

URDF 关节父子关系、局部运动轴与角度限位

核对限位值和单位

在 revolute 关节中,lower、upper 是弧度;示例肩关节为约 -90° 到 +90°,肘关节约 -68.8° 到 +68.8°。肩关节 velocity="1.0" 表示最大角速度 1.0 rad/s(约 57.3°/s),effort="20" 表示最大力矩 20 N·m。lower 应小于或等于 upper,且数值须对照真实减速器、机械止挡及安全余量。

关节类型 运动与位置边界 核对重点
revolute 绕轴转动,lower/upper 用 rad 角度不要误写成度
prismatic 沿轴移动,lower/upper 用 m velocity 用 m/s、effort 用 N
continuous 连续转动,没有位置上下限 仍须合理设置速度和力矩限值
fixed 不允许相对运动 无需设置运动轴与运动限位

关节零位由模型定义,并不等于电机上电位置,也不保证处在许可行程内。MoveIt 配置包中的 config/joint_limits.yaml 还可能收紧规划所用的速度、加速度或位置边界;最终执行必须另外遵守控制器和硬件保护限制,不能只靠 URDF 防止机械撞限位。

解析后检查真实转向

在 Ubuntu 24.04 上可先安装 liburdfdom-tools(sudo apt install liburdfdom-tools)。保存前面的文件后执行:

bash
if check_urdf /tmp/demo_arm.urdf >/dev/null 2>&1; then
  printf 'URDF parse: OK\n'
else
  printf 'URDF parse: FAILED\n' >&2
  exit 1
fi

预期输出:

text
URDF parse: OK

若失败,单独运行 check_urdf /tmp/demo_arm.urdf 查看缺失的 link、关节定义或 XML 错误。原模型如果使用 Xacro 宏,应先展开为 URDF 再检查。解析成功只证明模型可被读取,不能证明轴向符合真实机械臂。

对含可视化几何体的实际模型,可在 MoveIt Setup Assistant 的 Robot Poses 面板选中机械臂规划组,将各旋转关节从一个合法角度增加约 0.2 rad,观察子连杆是否按局部轴的右手定则运动;再检查允许行程两端的姿态是否符合机械结构。若方向相反,先对照硬件正方向和关节坐标系,再修正 axis 或 origin rpy,不要仅通过交换 lower 与 upper 掩盖问题。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

检查 URDF 关节轴与运动限位

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通