机器人 / 系统课时

统一右手系与角度单位

统一右手系与角度单位

同一组关节角在不同程序里算出相反的运动方向,常见原因是坐标轴、角度单位或向量乘法约定不一致。本课将这些约定固定为一套可验证的规则,并用绕 Z 轴旋转 90° 的算例检查结果。

学习目标

  • 依据右手定则定义三轴方向,判断正角旋转方向。
  • 在度与弧度之间正确换算,避免三角函数的单位错误。
  • 使用列向量左乘旋转矩阵,并通过数值结果校验约定。

用右手定则固定坐标轴

以移动机器人底盘为例,规定 +X 指向车头、+Y 指向车体左侧、+Z 指向上方。三轴应满足 ex×ey=ez\mathbf{e}_x\times\mathbf{e}_y=\mathbf{e}_z;如果把 +Y 改为车体右侧,却仍把 +Z 设为向上,坐标系就不再是右手系。

正角方向也由右手定则决定:右手大拇指指向旋转轴正方向,四指弯曲的方向为正旋转。站在 +Z 一侧向原点看,绕 +Z 轴的正角在 XY 平面内表现为逆时针;换到 -Z 一侧观察,视觉上的顺逆时针会反过来。

右手坐标系与绕正 Z 轴旋转的方向

在计算入口统一角度单位

运动控制界面常用度数显示角度,但 Python math.sin、math.cos 等三角函数接受弧度。读入角度后应在入口转换一次,内部统一按弧度计算,输出到界面时再按需要转回度数。

θrad=θdegπ180,θdeg=θrad180π\theta_{\mathrm{rad}}=\theta_{\mathrm{deg}}\frac{\pi}{180},\qquad \theta_{\mathrm{deg}}=\theta_{\mathrm{rad}}\frac{180}{\pi}
输入角度 计算用弧度
90° π/2≈1.5708\pi/2\approx1.5708
-90° −π/2≈−1.5708-\pi/2\approx-1.5708
180° π≈3.1416\pi\approx3.1416

角速度同样需要标明单位:90°/s 对应约 1.5708 rad/s。把数值 90 直接传给 math.sin,算出的不是 90° 的正弦;已经是弧度的值也不应再做一次度转弧度。

采用列向量和矩阵左乘

将位置点写成 3×13\times1 列向量 p=[x,y,z]T\mathbf{p}=[x,y,z]^T,规定主动旋转使用 p′=Rp\mathbf{p}'=R\mathbf{p}。绕固定 +Z 轴旋转角 θ\theta 时:

Rz(θ)=[cos⁡θ−sin⁡θ0sin⁡θcos⁡θ0001]R_z(\theta)= \begin{bmatrix} \cos\theta&-\sin\theta&0\\ \sin\theta&\cos\theta&0\\ 0&0&1 \end{bmatrix}

取 p=[1,0,0]T\mathbf{p}=[1,0,0]^T、θ=π/2\theta=\pi/2,结果应是 p′=[0,1,0]T\mathbf{p}'=[0,1,0]^T,而不是 [0,−1,0]T[0,-1,0]^T。若先绕 X 旋转、再绕 Z 旋转,列向量约定下写为 RzRxpR_zR_x\mathbf{p}:最右边的矩阵先作用,不能凭书写顺序交换两个矩阵。

涉及不同坐标系时,额外注明矩阵的方向。例如 pW=RBWpB+tBW\mathbf{p}^{W}=R^{W}_{B}\mathbf{p}^{B}+\mathbf{t}^{W}_{B} 表示把底盘系 B 的点坐标转换到世界系 W;这与“在同一坐标系内主动转动一个点”是不同的操作语义。

用数值测试核对方向和单位

以下示例可在 Python 3 中直接运行,输入使用度数,函数内部换算为弧度,再按上面的列向量公式计算:

python
import math

def rotate_z_deg(point, degrees):
    x, y, z = point
    angle = math.radians(degrees)  # 三角函数使用弧度
    c, s = math.cos(angle), math.sin(angle)
    # 等价于 Rz 左乘三维列向量
    return (c * x - s * y, s * x + c * y, z)

result = rotate_z_deg((1.0, 0.0, 0.0), 90)
print(tuple(round(v, 6) for v in result))
print(f"rad={math.radians(90):.6f}")

预期输出:

text
(0.0, 1.0, 0.0)
rad=1.570796

如果算出 Y 为负,优先检查旋转角符号、坐标轴指向,以及是否误用了行向量右乘;如果得到非零 X 且方向异常,检查是否把度数直接送入三角函数。接入新的运动学库时,先用这组单位轴与 90° 的测试验证约定,再计算真实关节链。

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

目录与阅读设置

阅读设置

17

记录一个想法

统一右手系与角度单位

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

登录哪都通