142、阻抗控制：力位混合控制的机器人交互
调试台上那台六轴机械臂又抖了。不是那种高频震颤，是那种低频的、带着闷响的、像人打寒颤一样的抖动。我盯着示波器上力传感器那条曲线，它正在以2赫兹左右的频率来回甩，幅度还不小。旁边实习生问了一句：“老师，是不是增益调太大了？”我摇头，把刚度矩阵里的对角项从800直接砍到200，曲线还是抖。最后发现根本不是增益问题——是位置环和力控环在同一个方向上打架，一个要往左推，一个要往右顶，两个控制器在暗地里拔河。
这就是阻抗控制最典型的坑：你以为你在做力控，实际上你的位置控制器根本没退出，两个环在同一个自由度上同时生效，结果就是系统在目标位置和期望力之间反复横跳。今天这篇笔记，就把阻抗控制这件事从头到尾掰开揉碎讲清楚，包括我踩过的那些坑。
阻抗控制这个名字本身就容易误导人。它不直接控制力，也不直接控制位置，它控制的是“力与位移之间的关系”。你可以把它理解成在机器人末端人为地装了一个弹簧阻尼系统——你推它，它给你一个反作用力，这个力的大小跟你的推入深度成正比，跟推入速度也有关。关键点在于，这个弹簧的刚度、阻尼系数都是你可以在程序里实时改的，而不是物理上焊死的。
从数学上讲，阻抗控制的目标方程长这样：
M_d * (x_ddot - x_ddot_d) + B_d * (x_dot - x_dot_d) + K_d * (x - x_d) = F_ext
其中M_d、B_d、K_d分别是期望惯性、期望阻尼、期望刚度，x是实际位置，x_d是期望位置，F_ext是外部接触力。这个方程的含义是：当外部力作用在末端时，位置偏差会按照这个二阶系统的动态特性来响应。如果你把K_d设得很大，系统就表现得像刚性位置控制；把K
