机械臂关节
配套页面:控制台上的「关节控制」页签。摆一摆滑块,比读十页文字管用。
1. 先分清三个数字#
第一次接触这台臂,最容易混的就是这几个数:
| 数字 | 是什么 | 别搞混 |
|---|---|---|
| 6 | 舵机数量 | 6 个舵机 ≠ 6 个自由度 |
| 5 | 关节数量(自由度,DOF) | 决定末端位置的只有这 5 个 |
| 4 | IK 实际求解的未知数 | pan / lift / elbow / wrist_flex;roll 由 wrist_roll 直接给,yaw 不可控 |
| 1 | 夹爪 | 它动的是手指,不改变 TCP,不算自由度 |
一句话:6 个舵机 = 5 个关节 + 1 个夹爪。
2. 从底座到指尖#
这是一条串联链,每一节的转动都会带着后面所有节一起动:
底座
└─ 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 也不动。测姿态时它不参与。
4. 为什么是 5 而不是 6#
想"把夹爪摆成空间中的任意朝向",需要 3 个位置 + 3 个姿态 = 6 个自由度。
这台臂只有 5 个,于是少掉的那一个体现在 yaw 不可控:
- 位置
(x, y, z)三个 - 进近角
pitch一个 - 腕滚
roll一个(wrist_roll直接给) - yaw 没有 —— 它是被 x / y 决定的
道理很直白:夹爪指向某个点,这个方向在水平面上的投影就唯一确定了"从哪个方位靠近"。你没法在保持位置的同时,让夹爪换个水平朝向。
代码里的体现就是 Pose 只有五个分量:
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。
越界时会得到:
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. 在页面上动手#
打开控制台的「关节控制」页签:
- 拖滑块 —— 六个关节,松开即下发,右侧模型跟着动
- 改数值 —— 滑块右侧是可以直接输入的角度,回车下发(Esc 撤销);想精确到 0.1° 时比拖滑块省事,超出关节限位会自动钳到边界
- 点「−20° / +20°」 —— 只动一个关节,看它到底影响什么;这是理解关节最快的方式
- 看遥测 —— 末端位姿和六个关节角会同步更新
- 做个小实验:把
wrist_flex调到 90°,再去「末端位姿」页把 Z 设成 230、点「IK 预检」,会得到Unreachable。这就是"5 自由度 + 竖直向下的代价"
仿真里随便试,安全层和真机是同一份代码。真机上试之前先看一眼周围。
位姿数值用的是哪套坐标系、TCP 是哪个点,见第 3 章:末端位姿。