第二节 运动学基础：刚体在空间中的位姿描述
各位同学，今天我们来聊聊运动学里最基础、也最绕不开的一块内容——刚体在空间里到底怎么描述它的位置和姿态。
说实话，我刚入行那会儿，觉得这玩意儿不就是几个坐标嘛，有啥好学的？直到第一次做机械臂标定，发现末端执行器死活对不准目标点，折腾了两天才意识到——哦，原来是旋转矩阵的顺序搞反了。嗯，从那以后，我再也不敢小看这些基础概念了。
一、刚体位姿：位置 + 姿态
一个刚体在三维空间里，有6个自由度。哪6个？三个平移（x, y, z），三个旋转（绕x轴、绕y轴、绕z轴）。说白了，就是你能把它挪到哪儿，以及它脸朝哪边。
我个人习惯把位姿拆成两部分来看：
- 位置：用一个3×1的向量 p = [x, y, z]^T 表示
- 姿态：用一个3×3的旋转矩阵 R 表示
合在一起，就是一个4×4的齐次变换矩阵 T。你想想看，这样是不是很直观？
核心公式：
T = [ R p ]
[ 0 1 ]其中 R 是3×3旋转矩阵，p 是3×1位置向量。
二、旋转矩阵：别搞反了顺序
旋转矩阵这东西，看着简单，用起来全是坑。我给大家总结三条铁律：
- 正交性：R^T * R = I，行列式为+1
- 顺序敏感：绕x轴转30°再绕y轴转60°，跟反过来完全不一样
- 逆矩阵 = 转置：R^(-1) = R^T，这个性质在求逆运动学时特别有用
我在项目中遇到过一件事：有个同事写代码时把绕z轴的旋转矩阵写成了绕y轴的，结果机械臂在抓取时总是偏了5度。排查了整整一下午，最后发现就是矩阵里一个sin和cos的位置写反了。你说冤不冤？
我的小技巧：写旋转矩阵时，先画个坐标系草图，标清楚哪个轴朝哪边，再动手写代码。别嫌麻烦，这能省你半天调试时间。
三、齐次变换矩阵：把旋转和平移打包
为什么要用4×4的齐次矩阵？因为这样可以把旋转和平移统一成一个矩阵乘法，方便做链式变换。
举个例子，一个坐标系{A}到坐标系{B}的变换：
T_B_A = [ R_B_A p_B_A ]
[ 0 1 ]那么点P在{A}下的坐标，转到{B}下就是：
p_B = T_B_A * p_A你想想看，如果没有齐次矩阵，你得先旋转再平移，写两行代码。有了它，一行搞定。这就是工程思维——能合并的绝不分开。
注意：齐次变换矩阵的乘法不满足交换律。T1 * T2 和 T2 * T1 结果完全不同。我曾经在写多关节机器人运动学时，就是因为搞反了变换顺序，导致仿真出来的轨迹像喝醉了酒一样乱晃。
四、正运动学：从关节角到位姿
正运动学，说白了就是：我知道每个关节转了多少度，求末端执行器在哪儿。
对于串联机器人，标准做法是用DH参数法。每个关节用一个齐次变换矩阵表示，然后全部乘起来：
T_0_n = T_0_1 * T_1_2 * ... * T_{n-1}_n这个计算过程很机械，但也很容易出错。我建议你写代码时，每算完一个关节的变换矩阵，就打印出来看一眼，确认数值对不对。
正运动学的特点：
- 解是唯一的——给定关节角，末端位姿是确定的
- 计算简单——就是矩阵连乘
- 适合实时控制——计算量小，速度快
五、逆运动学：从位姿反推关节角
逆运动学就麻烦多了。给你一个末端位姿，让你反算出每个关节的角度。这玩意儿有三大难题：
- 多解性：同一个位姿，可能有多种关节角组合
- 无解性：目标位姿超出了机器人的工作空间
- 奇异性：某些位姿下，关节角变化会导致末端剧烈抖动
我记得有一次做焊接机器人路径规划，目标点明明在可达范围内，但逆运动学就是算不出来。后来发现，是因为那个点刚好在奇异位形附近，数值解法直接发散掉了。
怎么解决？我一般用两种方法：
- 解析法：对于特定构型的机器人（比如6轴机器人满足Pieper准则），可以直接推导出封闭解。速度快，精度高。
- 数值法：用迭代优化，比如牛顿-拉夫森法。通用性强，但可能陷入局部最优。
实战建议：能解析就别用数值。解析法算出来的解是确定的，数值法你得调初始值、调步长、调收敛阈值，调到你怀疑人生。
六、知识体系总览
下面这张图是我自己整理的，把这一节的核心逻辑串起来了。你仔细看看，应该能对运动学有个整体把握。
七、避坑指南
最后，我把自己踩过的坑整理成几条，你记一下：
- 坐标系定义要统一：别今天用右手系，明天用左手系。我见过一个项目，因为坐标系不统一，两个模块算出来的结果差了180度。
- 角度单位别搞混：弧度还是角度？写代码时统一用弧度，显示时再转角度。我曾经在ROS里传参时忘了转换，机械臂直接打到限位。
- 验证每一步：每算完一个变换矩阵，用已知点验证一下。比如把原点[0,0,0]转过去，看看结果对不对。
- 备份你的DH参数表：这东西一旦丢了，重新标定能让你崩溃。我习惯在代码里硬编码一份，再在文档里备份一份。
好了，这一节的内容就到这儿。运动学是轨迹规划的基石，你把这些概念吃透了，后面学路径规划、速度规划、动力学控制都会轻松很多。
一句话总结：刚体位姿用齐次矩阵描述，正运动学是矩阵连乘，逆运动学是解方程。记住这三句话，你就抓住了运动学的精髓。
可可精品资料库