2、机械臂的数学模型：刚体变换、旋转矩阵、欧拉角、四元数、齐次变换矩阵

好，咱们进入正题。机械臂这东西，说白了就是一堆刚体串在一起。你让它动，本质上就是在算这些刚体之间的位置关系。我刚开始接触机器人学时，觉得这东西玄乎得很，后来发现核心就几个数学工具——旋转矩阵、欧拉角、四元数，再加上齐次变换矩阵。今天咱们就把它们捋清楚。

2.1 刚体变换：从“动一下”说起

什么叫刚体变换？你想想看，一个铁块在空间里又转又移，但它本身不变形——这就是刚体运动。在机械臂里，每个连杆都被视为刚体。我们要描述它从A姿态变成B姿态，就需要两个东西：旋转和平移。

我个人习惯把刚体变换拆成两步：先转，再移。顺序不能乱，因为旋转和平移不交换。嗯，这里要注意，如果你先移后转，结果完全不一样。我在项目中遇到过一位同事，就是搞混了顺序，结果仿真里机械臂直接飞出去了……

2.2 旋转矩阵：最直观的旋转表达

旋转矩阵，说白了就是一个3×3的正交矩阵，行列式为+1。它描述了一个坐标系相对于另一个坐标系的旋转关系。

举个例子，绕Z轴旋转θ角，旋转矩阵长这样：

R_z(θ) = [cosθ  -sinθ  0]
         [sinθ   cosθ  0]
         [0      0     1]

为什么用矩阵？因为方便啊！多个旋转可以连乘。比如先绕X轴转α，再绕Y轴转β，最后绕Z轴转γ，总的旋转矩阵就是：

R = R_z(γ) * R_y(β) * R_x(α)

注意顺序——矩阵乘法不交换。我刚开始学的时候总记反，后来养成了一个习惯：从右往左读，最右边的旋转最先发生。你试试看，是不是好记多了？

2.3 欧拉角：直观但容易踩坑

欧拉角是另一种表达旋转的方式。它用三个角度来描述：比如绕Z轴转ψ（偏航），绕Y轴转θ（俯仰），绕X轴转φ（滚转）。听起来很直观对吧？

但问题来了——万向锁。当俯仰角达到±90°时，偏航和滚转就分不清了。我曾经在调试一个六轴机械臂时，用欧拉角做插值，结果在某个奇异点附近，机械臂突然来了个180°大转弯……嗯，从那以后我再也不敢在运动规划里直接用欧拉角了。

表示方法	优点	缺点
旋转矩阵	无奇异，可连乘	9个参数，冗余
欧拉角	直观，3个参数	万向锁，插值困难
四元数	无奇异，可插值	不够直观

2.4 四元数：工业界的宠儿

四元数，听起来高大上，其实就是一个实部加三个虚部：q = w + xi + yj + zk。它没有万向锁问题，而且做插值（球面线性插值，SLERP）非常平滑。

我个人习惯在代码里用四元数做旋转，因为：

• 计算效率高（比矩阵少乘法）
• 存储省空间（4个浮点数 vs 9个）
• 插值自然（不会出现欧拉角的突变）

举个例子，从姿态A平滑过渡到姿态B，用四元数SLERP：

q(t) = (sin((1-t)Ω) / sinΩ) * qA + (sin(tΩ) / sinΩ) * qB

其中Ω是qA和qB之间的夹角。你看，t从0到1，姿态就平滑过去了。这在机械臂轨迹规划里非常实用。

2.5 齐次变换矩阵：把旋转和平移打包

好了，现在我们把旋转和平移合在一起。齐次变换矩阵T是一个4×4矩阵：

T = [R   p]
    [0   1]

其中R是3×3旋转矩阵，p是3×1平移向量。最后一行是[0 0 0 1]，这是齐次坐标的固定格式。

为什么用4×4？因为这样可以把旋转和平移统一成一个矩阵乘法。比如从基坐标系到末端执行器的变换：

T_0_n = T_0_1 * T_1_2 * ... * T_{n-1}_n

这就是机械臂运动学正解的核心。你想想看，每个关节的变换矩阵连乘起来，就得到了末端的位置和姿态。是不是很优雅？

2.6 知识体系总览

下面这张图是我自己画的，把本章的核心逻辑串起来了。你看一眼，心里就有谱了。

你看，从刚体变换出发，我们有了旋转和平移。旋转可以用矩阵、欧拉角或四元数表示，它们之间可以互相转换。最后全部打包进齐次变换矩阵，用于机械臂的运动学计算。这个逻辑链条，你记住了吗？

好了，这一章的内容就到这儿。数学工具是基础，后面咱们要用它们来推导机械臂的运动学方程。你先把这些概念消化掉，尤其是齐次变换矩阵的连乘——那是整个运动学仿真的核心。