机器人 / 系统课时

区分旋转关节和移动关节

区分旋转关节和移动关节

建立机械臂正运动学模型时,首先要判断每个关节允许哪一种相对运动。旋转关节改变构件的相对角度,移动关节改变构件沿指定轴的相对位移。区分两者后,才能正确选择关节变量、建立变换矩阵,并计算串联机械臂的末端位置与姿态。

学习目标

  • 根据运动约束识别旋转关节 R 与移动关节 P,并确定各自的自由度和变量单位。
  • 写出绕指定轴旋转和沿指定轴移动的齐次变换矩阵。
  • 使用一条 R-P 串联关节链计算末端位置,识别关节轴和变换顺序错误。

根据运动约束识别关节类型

理想旋转关节(Revolute Joint,R)允许两个相邻构件绕一条固定于关节坐标系的轴发生相对转动,其运动变量为角度 θ\theta。例如机械臂肩部转轴、肘部铰链。转动不会改变刚性构件自身的长度,但会改变其相对于父构件的方向。

理想移动关节(Prismatic Joint,P)允许两个相邻构件沿指定轴发生相对直线移动,其运动变量为位移 dd。例如直线滑台、伸缩执行机构。移动改变相邻构件的相对位置,但不会单独引入相对旋转。

比较项 旋转关节 R 移动关节 P
理想自由度 1 个转动自由度 1 个平移自由度
关节变量 θ\theta dd
常用单位 rad,展示时可用 ° m 或 mm
相对运动 绕关节轴旋转 沿关节轴移动
示例行程 -90°~90° 0~250 mm
单独产生的变化 相对姿态变化 相对位置变化

表中的行程只是示例设计约束,不代表所有关节的机械极限。实际建模时,应从机器人规格或关节限位数据读取上下限。

判断关节类型时不要只看外形。一个伸缩机构可能由旋转电机和丝杠驱动,但如果运动学建模关注的是滑块沿导轨的输出运动,就应将该运动副建模为 P 关节。

用齐次矩阵表达关节运动

齐次变换矩阵同时描述坐标系之间的旋转和平移。它是 4×44\times4 矩阵,左上角的 3×33\times3 部分描述旋转,最右列前三项描述平移,最后一行为 [0,0,0,1][0,0,0,1]。

约定使用右手坐标系、列向量和主动变换。先考虑一个绕局部 zz 轴旋转的 R 关节,其角度为 θ\theta,纯关节运动可以写为:

TR(θ)=[cos⁡θ−sin⁡θ00sin⁡θcos⁡θ0000100001]T_R(\theta)=\begin{bmatrix} \cos\theta&-\sin\theta&0&0\\ \sin\theta&\cos\theta&0&0\\ 0&0&1&0\\ 0&0&0&1 \end{bmatrix}

当 θ=0\theta=0 时,矩阵为单位矩阵;当 θ=90∘\theta=90^\circ 时,局部正 xx 轴转向正 yy 轴。矩阵右上角的平移部分仍为零,因为这里只表达绕关节原点的纯旋转。

再考虑沿局部 xx 轴移动的 P 关节,其位移为 dd:

TP(d)=[100d010000100001]T_P(d)=\begin{bmatrix} 1&0&0&d\\ 0&1&0&0\\ 0&0&1&0\\ 0&0&0&1 \end{bmatrix}

这里旋转部分始终是单位矩阵,只有平移分量随 dd 改变。若移动轴设为局部 zz 轴,变量 dd 就应出现在第三行第四列,而不是第一行第四列。

上述矩阵只表示可变关节运动。真实机械臂还存在固定连杆长度、安装偏移和关节零位偏差,这些需要使用额外的固定变换表示,不能全部塞进关节变量。

计算 R-P 串联关节链的末端位置

建立一条俯视平面机械臂:基座位于 O=(0,0)O=(0,0),第一个关节 R 绕垂直于平面的 zz 轴旋转;R 后连接长度为 aa 的刚性连杆,第二个关节 P 沿连杆的局部 xx 轴伸缩。末端工具点位于滑块前端。

旋转关节与移动关节的运动方向及平面 R-P 串联关系

取以下具体参数:

参数 数值 含义
aa 0.40 m 固定连杆长度
θ\theta 30° R 关节转角
dd 0.20 m P 关节伸长量
dd 的允许范围 0~0.25 m 滑块行程约束

采用列向量约定,右侧矩阵先作用,末端相对于基座的变换为:

T0E=TR(θ)Tx(a)TP(d)T_{0E}=T_R(\theta)T_x(a)T_P(d)

其中 Tx(a)T_x(a) 表示沿当前局部 xx 轴移动固定长度 aa。因为 Tx(a)T_x(a) 和 TP(d)T_P(d) 都沿同一局部轴平移,所以总伸出距离为 a+d=0.60a+d=0.60 m。

末端位置及平面朝向为:

xE=(a+d)cos⁡θyE=(a+d)sin⁡θψE=θ\begin{aligned} x_E&=(a+d)\cos\theta\\ y_E&=(a+d)\sin\theta\\ \psi_E&=\theta \end{aligned}

将 30∘30^\circ 转成弧度后计算,得到 xE≈0.5196x_E\approx0.5196 m、yE=0.3000y_E=0.3000 m,末端相对于基座旋转了 30°。

可以直接用 Python 3 标准库验证:

python
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")

预期输出:

text
x=0.5196 m, y=0.3000 m
yaw=30.0 deg

这个结果还可以通过几何关系检查:末端到基座的距离应为 0.60 m;将 R 关节角度改为 0° 后,末端应落在 (0.60,0)(0.60,0),而不是仍保持原来的 yy 坐标。

避免关节轴与变换顺序错误

串联机械臂中,子关节的运动轴通常随父构件的姿态改变。本例的 P 关节沿旋转后的局部 xx 轴伸缩,所以即使只增加 dd,末端在世界坐标系中的 xx 和 yy 位置也可能同时变化。

常见错误是先沿世界 xx 轴移动 0.60 m,再绕工具点自身旋转 30°。这相当于使用 Tx(a+d)TR(θ)T_x(a+d)T_R(\theta),计算出的末端位置为 (0.60,0)(0.60,0),与实际关节链不符。正确做法是按基座到末端的父子关系建立变换,并明确每段平移使用哪个局部坐标系。

还要检查三个工程边界:

  • 角度单位:数学库中的 sin、cos 通常使用弧度,30° 应先转换为约 0.5236 rad。
  • 关节零位:编码器零点不一定等于模型零位。存在固定偏置时,应明确使用 θ=θmeasured+θoffset\theta=\theta_{measured}+\theta_{offset},并按机械标定结果确定偏置符号。
  • 行程限制:R 的限位用角度表示,P 的限位用长度表示。本例若要求 d=0.30d=0.30 m,就超出了 0.25 m 的设定行程,不应作为正常可达构型。

最后做一个反向检查:固定 θ=30∘\theta=30^\circ,将 dd 从 0.20 m 改为 0.10 m,末端应沿原来的 30° 方向缩回 0.10 m,朝向保持不变。如果计算结果出现额外旋转,或末端沿世界坐标轴而非局部滑动轴移动,就需要重新检查关节类型、轴向定义及矩阵相乘顺序。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

区分旋转关节和移动关节

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通