一、课程导论：为什么轨迹规划与力矩控制必须联动？一个真实工业场景的痛点分析

大家好，我是你们这门课的主讲。在机器人行业摸爬滚打了十几年，我见过太多「规划归规划，控制归控制」的项目，最后都栽了跟头。

今天这第一节课，咱们不聊虚的。直接从一个我亲身经历的真实案例说起。你想想看，一个机器人要抓起一个易碎的玻璃杯，或者要打磨一个精密模具的边缘，如果轨迹规划和力矩控制各干各的，会发生什么？

几年前，我参与过一个协作机器人项目。任务很简单：让机器人从传送带上抓取玻璃杯，放到包装盒里。

我们团队当时分工很明确。搞轨迹规划的同事，用五次多项式算出了一条非常平滑的路径。从A点到B点，速度、加速度曲线都漂亮得像教科书一样。搞控制的同事呢，也把PID参数调得稳稳当当，位置跟踪误差在0.1毫米以内。

结果一跑起来，出事了。

机器人沿着规划好的路径运动，前半段一切正常。但当它接近目标位置，准备减速抓取时，末端夹爪突然开始剧烈抖动。杯子「啪」的一声，碎了。

为什么会这样？

我们排查了很久。最后发现，问题出在「规划」和「控制」的脱节上。轨迹规划器只考虑了位置和速度，完全没告诉控制器：这时候机器人手臂承受了多大的外力？关节需要输出多大的力矩？

说白了，规划层给控制层下达了一个「理想化」的指令。但真实世界里，有摩擦力、有重力、有惯性力。控制器为了死磕那个「理想位置」，只能拼命加大力矩，结果就产生了抖动。

核心痛点：轨迹规划只关心「怎么走」，力矩控制只关心「怎么跟」。两者之间没有信息交换，就像两个各说各话的聋子。

我个人习惯把这个问题拆成三个层面来看。你理解了这三个层面，就明白了这门课到底在解决什么问题。

你规划的轨迹再平滑，那也是数学上的平滑。真实机器人有柔性、有摩擦、有间隙。

举个例子。你规划了一个直线运动，要求关节以恒定速度转动。但实际中，关节减速器的摩擦力是非线性的。速度低的时候，摩擦力反而大。控制器为了维持速度，就得额外输出力矩。如果力矩控制不知道这个「额外需求」，位置就会偏离轨迹。

嗯，这里要注意：轨迹规划必须把「力矩需求」作为约束条件考虑进去。 否则，你规划的路径在物理上就是不可执行的。

如果你的机器人只是在天上飞（比如点焊），那位置控制就够了。但一旦涉及到与环境接触——打磨、装配、抓取——情况就完全不同了。

我记得有一次做力控打磨。工件表面有0.5毫米的起伏。如果只靠轨迹规划，机器人会严格按照预设路径走。遇到凸起的地方，打磨头就会「顶死」，压力暴增；遇到凹陷的地方，又磨不到。

这时候，必须让轨迹规划知道「当前接触力是多少」。规划层要根据力反馈，实时微调路径。这就是联动。

我的经验：在接触式任务中，轨迹规划不是「生成一条固定路径」，而是「生成一个力控策略的参考框架」。力矩控制则在这个框架内做精细调整。

你想想看，一个机器人要跑得快，又要跑得稳。这本身就是一对矛盾。

轨迹规划决定了「期望加速度」。而根据牛顿第二定律，加速度直接对应力矩。如果规划出的加速度超过了电机能提供的最大力矩，那控制器再怎么努力也追不上。

我曾经见过一个工程师，为了追求节拍，把轨迹的加速度设得特别高。结果电机一直处于饱和状态，不仅位置跟踪误差大，电机还过热报警。

所以，轨迹规划必须知道电机的力矩极限。 反过来，力矩控制也要知道规划的目标是什么，不能盲目地「追位置」。

下面这张图，是我自己总结的「轨迹-力矩联动」核心框架。你看一眼，就能明白它们之间是怎么配合的。

你看，左边是轨迹规划，右边是力矩控制。中间是联动接口。箭头是双向的。轨迹规划给力矩控制提供「期望轨迹」，力矩控制给轨迹规划反馈「力矩约束」和「实际状态」。两者互相修正，形成一个闭环。

这才是工业级机器人该有的样子。

说白了，这门课就是教你如何搭建这个「双向通道」。我会从最基础的动力学模型讲起，然后一步步教你如何把力矩约束嵌入到轨迹规划中，再教你如何设计能感知力矩的控制器。

我建议你带着问题来学。比如：

这些问题，在这门课里都能找到答案。

避坑指南：我曾经见过有人把轨迹规划和力矩控制强行「拼凑」在一起，结果系统不稳定，反而比单独控制更差。记住，联动不是简单的叠加，而是深度的融合。后面我会专门讲如何避免这种「伪联动」。