机器人 / 系统课时
区分旋转关节和移动关节
区分旋转关节和移动关节
建立机械臂正运动学模型时,首先要判断每个关节允许哪一种相对运动。旋转关节改变构件的相对角度,移动关节改变构件沿指定轴的相对位移。区分两者后,才能正确选择关节变量、建立变换矩阵,并计算串联机械臂的末端位置与姿态。
学习目标
- 根据运动约束识别旋转关节 R 与移动关节 P,并确定各自的自由度和变量单位。
- 写出绕指定轴旋转和沿指定轴移动的齐次变换矩阵。
- 使用一条 R-P 串联关节链计算末端位置,识别关节轴和变换顺序错误。
根据运动约束识别关节类型
理想旋转关节(Revolute Joint,R)允许两个相邻构件绕一条固定于关节坐标系的轴发生相对转动,其运动变量为角度 。例如机械臂肩部转轴、肘部铰链。转动不会改变刚性构件自身的长度,但会改变其相对于父构件的方向。
理想移动关节(Prismatic Joint,P)允许两个相邻构件沿指定轴发生相对直线移动,其运动变量为位移 。例如直线滑台、伸缩执行机构。移动改变相邻构件的相对位置,但不会单独引入相对旋转。
| 比较项 | 旋转关节 R | 移动关节 P |
|---|---|---|
| 理想自由度 | 1 个转动自由度 | 1 个平移自由度 |
| 关节变量 | ||
| 常用单位 | rad,展示时可用 ° | m 或 mm |
| 相对运动 | 绕关节轴旋转 | 沿关节轴移动 |
| 示例行程 | -90°~90° | 0~250 mm |
| 单独产生的变化 | 相对姿态变化 | 相对位置变化 |
表中的行程只是示例设计约束,不代表所有关节的机械极限。实际建模时,应从机器人规格或关节限位数据读取上下限。
判断关节类型时不要只看外形。一个伸缩机构可能由旋转电机和丝杠驱动,但如果运动学建模关注的是滑块沿导轨的输出运动,就应将该运动副建模为 P 关节。
用齐次矩阵表达关节运动
齐次变换矩阵同时描述坐标系之间的旋转和平移。它是 矩阵,左上角的 部分描述旋转,最右列前三项描述平移,最后一行为 。
约定使用右手坐标系、列向量和主动变换。先考虑一个绕局部 轴旋转的 R 关节,其角度为 ,纯关节运动可以写为:
当 时,矩阵为单位矩阵;当 时,局部正 轴转向正 轴。矩阵右上角的平移部分仍为零,因为这里只表达绕关节原点的纯旋转。
再考虑沿局部 轴移动的 P 关节,其位移为 :
这里旋转部分始终是单位矩阵,只有平移分量随 改变。若移动轴设为局部 轴,变量 就应出现在第三行第四列,而不是第一行第四列。
上述矩阵只表示可变关节运动。真实机械臂还存在固定连杆长度、安装偏移和关节零位偏差,这些需要使用额外的固定变换表示,不能全部塞进关节变量。
计算 R-P 串联关节链的末端位置
建立一条俯视平面机械臂:基座位于 ,第一个关节 R 绕垂直于平面的 轴旋转;R 后连接长度为 的刚性连杆,第二个关节 P 沿连杆的局部 轴伸缩。末端工具点位于滑块前端。

取以下具体参数:
| 参数 | 数值 | 含义 |
|---|---|---|
| 0.40 m | 固定连杆长度 | |
| 30° | R 关节转角 | |
| 0.20 m | P 关节伸长量 | |
| 的允许范围 | 0~0.25 m | 滑块行程约束 |
采用列向量约定,右侧矩阵先作用,末端相对于基座的变换为:
其中 表示沿当前局部 轴移动固定长度 。因为 和 都沿同一局部轴平移,所以总伸出距离为 m。
末端位置及平面朝向为:
将 转成弧度后计算,得到 m、 m,末端相对于基座旋转了 30°。
可以直接用 Python 3 标准库验证:
from math import cos, sin, radians
# 长度统一用米,三角函数输入统一用弧度
a = 0.40
d = 0.20
theta_deg = 30.0
theta = radians(theta_deg)
# 滑动轴跟随父关节旋转,先计算局部伸出距离
reach = a + d
x = reach * cos(theta)
y = reach * sin(theta)
print(f"x={x:.4f} m, y={y:.4f} m")
print(f"yaw={theta_deg:.1f} deg")预期输出:
x=0.5196 m, y=0.3000 m
yaw=30.0 deg这个结果还可以通过几何关系检查:末端到基座的距离应为 0.60 m;将 R 关节角度改为 0° 后,末端应落在 ,而不是仍保持原来的 坐标。
避免关节轴与变换顺序错误
串联机械臂中,子关节的运动轴通常随父构件的姿态改变。本例的 P 关节沿旋转后的局部 轴伸缩,所以即使只增加 ,末端在世界坐标系中的 和 位置也可能同时变化。
常见错误是先沿世界 轴移动 0.60 m,再绕工具点自身旋转 30°。这相当于使用 ,计算出的末端位置为 ,与实际关节链不符。正确做法是按基座到末端的父子关系建立变换,并明确每段平移使用哪个局部坐标系。
还要检查三个工程边界:
- 角度单位:数学库中的
sin、cos通常使用弧度,30° 应先转换为约 0.5236 rad。 - 关节零位:编码器零点不一定等于模型零位。存在固定偏置时,应明确使用 ,并按机械标定结果确定偏置符号。
- 行程限制:R 的限位用角度表示,P 的限位用长度表示。本例若要求 m,就超出了 0.25 m 的设定行程,不应作为正常可达构型。
最后做一个反向检查:固定 ,将 从 0.20 m 改为 0.10 m,末端应沿原来的 30° 方向缩回 0.10 m,朝向保持不变。如果计算结果出现额外旋转,或末端沿世界坐标轴而非局部滑动轴移动,就需要重新检查关节类型、轴向定义及矩阵相乘顺序。