URDF 模型与仿真控制

01问题引入：机械臂为什么这样设计

机械臂不是凭空画出来的——它是照着一条手臂"仿"出来的：底座回转像肩、两节臂杆像大臂小臂、腕部两关节像手腕、夹爪像手指。先把下图这副数字身体当成"一条手臂"来看：它为什么被设计成这样？哪里在仿人，哪里又故意和人不一样？

# 在带有 GUI 界面的终端运行：实验箱屏幕、VNC 或 MobaxTerm（纯 SSH 黑窗弹不出图形窗口）
ros2 launch car1_description display.launch.py

下面三张卡就是"哪里仿人、哪里故意不一样"的三条线索——它们的答案全部写在一份说明书（car1.urdf）里，而且就在这屏左右两个窗口里看得见：

02上手第一步：RViz 仿真跑起来

# 就这三步——注意每个新终端都要重新 source 两次
colcon build --packages-select car1_description
source install/setup.bash
ros2 launch car1_description display.launch.py

对照 01 节截图，两个窗口的分工与用法：

窗口里的事摸出问题了？左窗发布、右窗订阅，先把三个词讲清，链路才看得懂 → 03 关节 · 限位 · 角色

03关节 · 限位 · 角色

关节（叫什么）、限位（能转多少）、角色（干什么用）——一个关节一行，一次讲透。限位按角度分两层标注：URDF 层 = display 里滑块的真实行程（文件里实际写的是弧度，04 节见原文）；实机层 = 270° 舵机真正能去的地方：

把两条限位画在同一把尺子上，红区就是"仿真放行、实机撞墙"的 45° 危险带：

三个词立好了，钻进说明书对原文 → 04 深读一：URDF 简化说明

04深读一：display 用的 URDF 简化说明

刚跑的 display.launch.py 加载的是 ros2_ws/src/xflz_eai_car1/simulations/car1_description/urdf/ 下的 car1.urdf（launch 源码原句：os.path.join(pkg_share, 'urdf', 'car1.urdf')）。语法前置课都学过，这里做"简化版导览"——把上千行剥到骨架，每个标签对应你刚玩过的一个现象：

<robot name="car1">
  <!-- ① 每段"骨骼" = 你看到的一个零件 -->
  <link name="base_link">
    <visual>    外形 + mesh 资源路径（洋红色=这里写错） </visual>
    <collision> 碰撞外壳（为将来的物理世界预留） </collision>
    <inertial>  质量与惯量（Gazebo 才真正用到） </inertial>
  </link>

  <!-- ② 每个"关节" = 你拖的一个滑块（以底座回转为例） -->
  <joint name="arm_joint1" type="revolute">   <!-- 旋转关节 -->
    <parent link="base_link"/>                <!-- 挂在谁身上 -->
    <child  link="link1"/>                     <!-- 长出谁 -->
    <origin xyz="0 0 0.1" rpy="0 0 0"/>       <!-- 相对父的安装位姿 -->
    <axis   xyz="0 0 1"/>                     <!-- 绕哪根轴转=滑块调的量 -->
    <limit  lower="-3.14" upper="3.14"         <!-- 数字止挡=03 节限位表出处 -->
            effort="…" velocity="…"/>
  </joint>

  <!-- ③ 末端与眼睛：坐标系立在各自 link 上 -->
  <link name="tcp_link"/>     <!-- 指尖参考点：IK 落点 -->
  <link name="camera_link"/>  <!-- 相机光心：视觉起点 -->

  <!-- ④ 夹爪 r_joint 也是旋转关节：URDF 管行程，实机开合另有 PWM 口径 -->
  <joint name="r_joint" type="revolute">
    <limit lower="-3.14" upper="3.14"/>  <!-- ±180°；实机 800~1500 μs，EXP-02 换算 -->
  </joint>
</robot>

把上面的父子关系装起来看一眼——五节臂怎么一节节长出来：

说明书看完了，回头看"读它的程序"——这条 launch 到底启动了谁、话怎么传 → 05 深读二：display 架构解析。

05深读二：display.launch.py 架构解析

一条命令、两个窗口——背后其实是 一个 launch 文件拉起三个节点、两条话题接力。三问拆解：框架什么样？话题谁发谁收？怎么用命令证明？

看这张图先盯一个细节：蓝色箭头上有个点在向右跑（关节角消息），青色箭头上也有个点在跑（坐标变换），而且青点总是晚半拍——晚的这一拍，就是"先有角度、才算变换"的因果顺序：

这就是本节结论：没有左端发布的角度，右端就无从订阅——06 节动手任务要你"顶替 GUI 当发布者"，顶的正是链条最左边那个口。

① 发布订阅清单——把上图的箭头变成一张表：

② 如何验证——五个命令 + 预期结论（每新开一个终端先两次 source）：

# 1) 节点都在吗：launch 的三兄弟 jsp_gui / rsp / rviz2 都在即合格
#    多出来的名字有来路，不算异常：
#    · transform_listener_impl_xxxx 是 rviz2 的 TF 监听器自动注册的框架节点
#      （后缀十六进制每次启动都变，不是谁手写的）
ros2 node list

# 2) 话题清单：确认出现 /joint_states 与 /tf（/tf_static）
ros2 topic list

# 3) 谁发谁收：预期 publisher=1、subscription≥1（rsp 在收）
ros2 topic info /joint_states

# 4) 打包内容：name 与 position 两个数组同序、下标对应
ros2 topic echo /joint_states --once

# 5) 边拖滑块边跑：频率 > 0 = 心跳健康；按住不放看 position 变化
ros2 topic hz /joint_states

③ rviz2 介绍——对着 01 节截图右窗认面板：

一屏两窗一条链都拆完了，收个尾 → 06 总结与思考

06总结与思考

① 验收清单——七条全做到，这一节才算过：

• 一条 ros2 launch car1_description display.launch.py 起手，能说出弹出的两个窗口各是谁
• 拖遍 GUI 滑块：逐个报出 joint 名称、角色与限位，并能演示夹爪开合（r_joint 旋转行程）
• 在 RViz2 勾选 TF，认出 base_link / camera_link / tcp_link，并解释 Fixed Frame 的含义
• 用 view_frames 生成 TF 树 PDF，用 ros2 topic hz /joint_states 验证心跳
• 用 ros2 topic pub 往 /joint_states 写关节角驱动模型，并说清 GUI 在链路中的真实角色
• 读完 04 节：在 URDF 简化版里指认任意关节的 limit / axis / parent-child 三要素
• 读完 05 节：画得出 display 的框架流程图，说得出 /joint_states 与 /tf 谁发谁收、怎么用命令验证

② 动手任务——按 6 项自己做一遍，缺哪项补哪项：

02 节是跟着做，这 6 项自己来——边做边回答后面列出的三个观察题：

1. 重跑一遍：新开终端 → 两次 source → launch（02 节三步，这次独立完成）
2. 逐滑块从头拖到尾：给每个关节归类——谁管"方位"、谁管"距离"、谁管"姿态"、谁管"开合"？末端到不了的空间盲区在哪
3. 玩 Randomize / Center：随机姿态下 tcp_link 还在你预期的位置吗？一键归零找"home 态"
4. RViz 开 TF 面板逐帧勾选：把 base_link / camera_link / tcp_link 全勾出来；试两件事——① Fixed Frame 从 base_link 切到 tcp_link，看整体"世界"如何重排 ② Orbit 视角（左键旋转 / 右键平移 / 滚轮缩放）绕模型一圈
5. 两条验证命令：生成 TF 树 PDF + 查心跳（下方代码框），对照截图里那一屏坐标轴
6. 绕过 GUI 直接发话：GUI 究竟是"被谁控制"的？先看它往哪发（hz 有心跳），再用下方命令自己往 /joint_states 写关节角——底座依次转 正前（0）→ 斜前 +45° → 斜前 −45°（±0.785 rad），观察哪边是前左、哪边是前右

# 生成 TF 树：预期 7+ 坐标系一张 PDF，base_link 单根无环
ros2 run tf2_tools view_frames

# 查心跳：拖动滑块期间频率 > 0、position 数值在变；为 0 则模型不会更新
ros2 topic hz /joint_states

# 顶替 GUI 当发布者——谁往 /joint_states 发消息，订阅方（robot_state_publisher）就听谁的
# GUI 开着会持续发布盖过你的单发：先关掉左窗再发（发完姿态常驻，直到下次有人发言）
ros2 topic pub --once /joint_states sensor_msgs/msg/JointState "{name: [arm_joint1], position: [0.0]}"     # 正前（零位）0 rad
ros2 topic pub --once /joint_states sensor_msgs/msg/JointState "{name: [arm_joint1], position: [0.785]}"    # 斜前一翼 +45°
ros2 topic pub --once /joint_states sensor_msgs/msg/JointState "{name: [arm_joint1], position: [-0.785]}"   # 斜前另一翼 −45°（哪边是前左自己记录）