🦾 关节状态与动作控制

55.0°
-45.0°
-10.0°
1.0x

🎯 机器人速度分析核心问题定义

1. 待解决的核心问题 核心目标
已知机械臂当前的关节位置与关节转速，求解末端的线速度与角速度：
2. 实时末端速度状态 (Live Velocities) 静止
⚪ 状态：准备就绪，可拖动滑块或演示抓取
3. 为什么求导只成功了一半？ 🔍 点击全屏聚焦
线速度 ${}^0\mathbf{v}_n = \frac{\mathrm{d}}{\mathrm{d}t}({}^0\mathbf{p}_n) \in \mathbb{R}^3$ (直接求导成功 ✅)
角速度 $\frac{\mathrm{d}}{\mathrm{d}t}({}^0R_n) \in \mathbb{R}^{3\times 3} \;\neq\; {}^0\boldsymbol{\omega}_n \in \mathbb{R}^3$ (形状不匹配 ❓)
📐 深度剖析：为什么对位姿齐次矩阵求导“只成功了一半”？
📌 正运动学计算出的末端位姿齐次矩阵（世界坐标系下）：
✅ 前半场：线速度提取（直接求导成功） 维度完美匹配
  • 位置 ${}^0\mathbf{p}_n(t)$ 本身就是一个 $3 \times 1$ 的空间坐标向量；
  • 对时间求一阶导数 $\frac{\mathrm{d}}{\mathrm{d}t}({}^0\mathbf{p}_n)$，自然得到 $3 \times 1$ 的线速度向量 ${}^0\mathbf{v}_n$；
  • 物理意义正确，维度正确。
❌ 后半场：角速度困境（形状根本不匹配） 核心矛盾
  • 物理世界中，角速度是一个 $3 \times 1$ 向量 ${}^0\boldsymbol{\omega}_n$（转轴方向 + 旋转速率）；
  • 但旋转矩阵求导 $\frac{\mathrm{d}}{\mathrm{d}t}({}^0R_n)$ 却是一个 $3 \times 3$ 矩阵；
  • 矛盾所在：物理意义不对, 维度也不对。
💡 破局之道：能不能想个办法，把 3 维角速度向量从 $3 \times 3$ 的矩阵导数中“提取”出来？
左键旋转视角 | 滚轮缩放 | 拖动滑块演示抓取 | 点击右侧卡片 3 可全屏聚焦讲解