SO-101
课程总览/第 02 章 · 机械臂关节
EN
第 02 章运动学约 12 分钟

机械臂关节

配套页面:控制台上的「关节控制」页签。摆一摆滑块,比读十页文字管用。

7 个小节 1 张图 3 段代码 自由度关节限位
关节控制页

1. 先分清三个数字#

第一次接触这台臂,最容易混的就是这几个数:

数字 是什么 别搞混
6 舵机数量 6 个舵机 ≠ 6 个自由度
5 关节数量(自由度,DOF) 决定末端位置的只有这 5 个
4 IK 实际求解的未知数 pan / lift / elbow / wrist_flex;roll 由 wrist_roll 直接给,yaw 不可控
1 夹爪 它动的是手指,不改变 TCP,不算自由度

一句话:6 个舵机 = 5 个关节 + 1 个夹爪。

2. 从底座到指尖#

这是一条串联链,每一节的转动都会带着后面所有节一起动:

text
底座
 └─ Rotation   肩部水平旋转
     └─ Pitch      大臂俯仰
         └─ Elbow      肘部弯曲
             └─ Wrist_Pitch  腕部俯仰
                 └─ Wrist_Roll   腕部滚转
                     └─ Jaw          夹爪活动指

前两列是 SDK 名和 URDF 名(lerobot 命名 / URDF 命名),一一对应:

SDK / lerobot URDF 中文 轴 URDF 限位
shoulder_pan Rotation 底座旋转 竖直 −110° ~ 110°
shoulder_lift Pitch 大臂俯仰 水平 −100° ~ 100°
elbow_flex Elbow 肘部弯曲 水平 −100° ~ 90°
wrist_flex Wrist_Pitch 腕部俯仰 水平 −95° ~ 95°
wrist_roll Wrist_Roll 腕部滚转 沿进近轴 −160° ~ 160°
gripper Jaw 夹爪开合 — −10° ~ 100°

代码里不要用 URDF 名。starm 对外只认第一列,URDF_JOINT_NAMES 负责在内部翻译。

3. 每个关节到底管什么#

关节 它决定 动一下会看到
shoulder_pan TCP 的水平方位角(x、y 同时变),以及进近方向的水平朝向 整条手臂像扫帚一样扫过桌面
shoulder_lift 工作高度与臂展 手臂抬起 / 放下,末端画一个大圆弧
elbow_flex 末端离底座多远 前臂相对大臂折起来,伸远或收到近处
wrist_flex 夹爪的进近角 pitch 夹爪抬头 / 低头;调到 90 就是垂直向下
wrist_roll 夹爪绕自身轴的转角 roll 两根手指转圈,但 TCP 基本不动
gripper 两指间距 张开 / 闭合,TCP 完全不动

几个值得记住的点#

shoulder_lift 最吃力。 它要把后面所有节连同负载一起托起来。手臂伸得越平,力臂越大。这也是为什么标称 500 g 负载只在特定姿态成立。

elbow_flex 决定"伸多远"。 同一个目标点通常有两种构型——肘上(elbow 朝上)和肘下。 IK 用种子决定收敛到哪一种,path="line" 时还会禁止中途换构型,否则手臂会横扫过去。

wrist_flex 是 pitch 的直接来源。 pitch=90 表示夹爪竖直向下;此时能到达的最高点只有桌面上方约 80 mm,pitch=75 能到 120 mm 左右。够不着时先想到它。

wrist_roll 是唯一基本不改变 TCP 位置的关节。 说"基本"是因为 TCP 相对腕部轴线有约 10 mm 的横向偏移(tcp_offset 的 x 分量是 −10.1 mm),所以严格说转动时 TCP 会画一个很小的圆。

gripper 不是自由度。 它只驱动活动指,静态指不动,TCP 也不动。测姿态时它不参与。

互动实验

关节实验台

URDF · 实时 FK

拖五个关节看看末端怎么走。骨架用的是 URDF 里的关节原点和轴,TCP 与第 4 章的零位实测一致;夹爪不影响 TCP。

关节TCP桌面
X20.4mm
Y−381.1mm
Z256.8mm
PITCH0.0°
ROLL0.0°
零位 TCP 为 (20.4, −381.1, 256.8) mm;这是基座系,桌面在 z = 30.1 mm。“抓取姿态”就是第 4 章 IK 往返实验里的那组解。

4. 为什么是 5 而不是 6#

想"把夹爪摆成空间中的任意朝向",需要 3 个位置 + 3 个姿态 = 6 个自由度。

这台臂只有 5 个,于是少掉的那一个体现在 yaw 不可控:

  • 位置 (x, y, z) 三个
  • 进近角 pitch 一个
  • 腕滚 roll 一个(wrist_roll 直接给)
  • yaw 没有 —— 它是被 x / y 决定的

道理很直白:夹爪指向某个点,这个方向在水平面上的投影就唯一确定了"从哪个方位靠近"。你没法在保持位置的同时,让夹爪换个水平朝向。

代码里的体现就是 Pose 只有五个分量:

python
Pose(x, y, z, pitch, roll)   # 没有 yaw

pitch=90 时还有个副作用:进近方向竖直向下,水平投影退化成零,此时 yaw 干脆没有意义。

关节数量对比#

关节数 能控制 做不到
3 轴 末端位置 x / y / z 姿态完全不可控
4 轴 位置 + 一个进近角 pitch 夹爪绕自身轴的朝向是固定的
5 轴 · 本机 位置 + pitch + roll yaw 不能独立指定
6 轴 位置 + 完整姿态 ——
7 轴 6 轴 + 冗余自由度 ——(多出来的一轴用来避障、绕奇异)

工业上说的"六轴机器人"指的是 6 个关节,不是 6 个电机。本机是 5 关节 + 1 夹爪,所以严格说是一台 5 自由度机械臂。

从末端位姿的角度看这 5 个自由度是怎么变成 5 个数字的,见 第 3 章。

5. 限位:就用关节自己的上下限#

URDF 里每个关节都写了 <limit lower=… upper=…>,那就是这个关节真正的上下限。安全层原样使用,不再内缩、也不再按标定行程收窄:

关节 上下限(URDF)
shoulder_pan ±110
shoulder_lift ±100
elbow_flex −100 ~ 90
wrist_flex ±95
wrist_roll ±160
gripper 0 ~ 100 %

夹爪是个例外:URDF 里写的是爪指转角(−10…100°),而 SDK 下发的是 0–100 % 开度,所以安全层按百分比把两端取成 0 和 100。

越界时会得到:

text
SafetyError: shoulder_pan target 130.00 is outside soft limits [-110.0, 110.0]

以前这里还有一层"软限位":先按标定行程替换 URDF,再整体内缩 2°。两个副作用都在现场露过脸——标定行程是中心对称的,长边那几度被丢掉(elbow_flex 只到 ±88.7,URDF 明明给的是 −100…90);内缩 2° 又让每个关节都在离端点还有两度的地方停住。现在这层去掉了。

想要一点余量(齿隙、断电后重力下沉)就把 ~/.starm/config.toml 里 [safety] limit_margin_deg 调大(默认 0);想按实测标定行程收窄就设 limit_source = "calibration",两者取交集设 "narrower"。

如果机械臂已经在限位外(比如断电后下垂),规则是:允许保持、允许向内恢复,不允许继续往外。否则它会被卡死在边界上,怎么命令都拒绝。

6. 常见误区#

说法 对不对 说明
"6 个舵机就是 6 自由度" ✗ 夹爪不参与定位
"夹爪也算一个自由度" ✗ 它只改变两指间距
"关节角能随便设" ✗ 停在该关节自己的上下限(URDF)上;夹爪按 0–100 %
"腕部滚转不影响末端位置" ≈ TCP 有约 10 mm 横向偏移,会画小圆
"5 轴够不到是因为电机没劲" ✗ 是几何上就到不了,Unreachable 不是 SafetyError

7. 在页面上动手#

打开控制台的「关节控制」页签:

  1. 拖滑块 —— 六个关节,松开即下发,右侧模型跟着动
  2. 改数值 —— 滑块右侧是可以直接输入的角度,回车下发(Esc 撤销);想精确到 0.1° 时比拖滑块省事,超出关节限位会自动钳到边界
  3. 点「−20° / +20°」 —— 只动一个关节,看它到底影响什么;这是理解关节最快的方式
  4. 看遥测 —— 末端位姿和六个关节角会同步更新
  5. 做个小实验:把 wrist_flex 调到 90°,再去「末端位姿」页把 Z 设成 230、点「IK 预检」,会得到 Unreachable。这就是"5 自由度 + 竖直向下的代价"

仿真里随便试,安全层和真机是同一份代码。真机上试之前先看一眼周围。

位姿数值用的是哪套坐标系、TCP 是哪个点,见第 3 章:末端位姿。