4、笛卡尔空间力矩控制：阻抗控制原理、导纳控制原理、力位混合控制

各位，咱们今天聊点硬核的。笛卡尔空间的力矩控制，说白了就是让机器人末端跟环境打交道时，不再是个愣头青。你想想看，位置控制虽然精准，但遇到墙、碰到人，硬碰硬肯定不行。这时候就需要力矩控制登场了。

我个人习惯把这类控制分成三大流派：阻抗控制、导纳控制、力位混合控制。它们各有各的脾气，也各有各的适用场景。我在项目里踩过不少坑，今天一并分享给你们。

阻抗控制，名字听着玄乎，其实核心思想很简单：让机器人末端表现出一个虚拟的弹簧-阻尼-质量系统。你推它，它让开；你拉它，它跟着走。就像你推一个漂浮在水面的球，球会顺着你的力移动，但又有一定的阻力。

核心公式：

M * (ẍ_d - ẍ) + B * (ẋ_d - ẋ) + K * (x_d - x) = F_ext

其中：M是虚拟质量，B是虚拟阻尼，K是虚拟刚度，F_ext是外部施加的力。

这里有个关键点：阻抗控制是主动的。它通过调整位置偏差来产生力响应。说白了，就是机器人感知到位置偏差后，主动输出一个力来对抗这个偏差。

我记得有一次做协作机器人项目，需要让机器人在装配时保持一定的柔顺性。我一开始把刚度K设得特别大，结果机器人跟环境一接触就震荡。后来把K调小，B调大，才稳定下来。嗯，这里要注意：阻尼参数B是稳定性的关键，太小了会震荡，太大了响应又慢。

我的经验：阻抗控制适合在已知环境刚度的情况下使用。如果环境刚度变化很大，比如一会儿接触硬金属，一会儿接触软橡胶，那阻抗控制的参数就需要在线调整。

导纳控制跟阻抗控制正好是“镜像关系”。导纳控制是被动的——它测量外力，然后调整位置或速度来响应这个力。你想想看，这就像你推一个门，门会根据你推的力大小来决定开多大角度。

导纳控制的核心公式是：

F_ext = M * ẍ_d + B * ẋ_d + K * x_d

这里，F_ext是测量到的外力，然后我们解算出期望的位置x_d、速度ẋ_d和加速度ẍ_d。说白了，就是力输入，位置输出。

我在做手术机器人项目时，导纳控制帮了大忙。医生操作主手时，从手需要精确跟随力反馈。导纳控制让从手在接触组织时能“顺着”医生的力走，既不会戳穿组织，又能完成精细操作。

避坑指南：我曾经在导纳控制中忽略了力传感器的噪声。结果机器人末端一直在微颤，像得了帕金森。后来加了低通滤波器，才把这个问题解决。力传感器信号一定要做滤波处理，尤其是高频噪声。

导纳控制和阻抗控制怎么选？我个人建议：如果你的机器人有力传感器，用导纳控制更直接；如果没有力传感器，只有电流环力矩估计，那阻抗控制更合适。当然，这不是的，具体要看你的硬件条件。

力位混合控制，这个名字就暴露了它的本质——在任务空间的不同方向上，同时控制力和位置。比如你让机器人用砂纸打磨一个曲面，沿着曲面法线方向要控制力（保持恒定压力），沿着切线方向要控制位置（沿着轨迹走）。

力位混合控制的核心思想是：把任务空间分解成两个正交的子空间——力控制子空间和位置控制子空间。

控制模式	适用方向	典型应用
位置控制	自由运动方向	轨迹跟踪、避障
力控制	约束运动方向	打磨、装配、抛光

实现上，我们需要一个选择矩阵S。S的对角线元素是1或0：1表示该方向用力控制，0表示用位置控制。然后两个控制器并行工作，最后把输出叠加起来。

τ = S * τ_force + (I - S) * τ_position

这里τ_force是力控制器的输出，τ_position是位置控制器的输出，I是单位矩阵。

我在做机器人去毛刺项目时用过力位混合控制。当时工件表面有铸造毛刺，机器人需要沿着边缘走，同时保持恒定的接触力。一开始我用了纯阻抗控制，结果遇到硬毛刺时力会突变。换成力位混合控制后，法线方向用力控制，切线方向用位置控制，效果好了很多。

关键点：力位混合控制需要精确的任务空间分解。如果分解错了，比如本应该用力控制的方向用了位置控制，那机器人要么撞坏工件，要么飞出去。我曾经就犯过这个错，把法线方向搞反了，结果机器人直接怼到工件上，还好有急停。

说了这么多，咱们来总结一下。这三种控制策略各有千秋，选哪个取决于你的具体需求。

控制策略	输入	输出	传感器需求	典型场景
阻抗控制	位置偏差	力	位置传感器（编码器）	人机协作、装配
导纳控制	外力	位置	力/力矩传感器	手术机器人、力反馈遥操作
力位混合控制	位置+力	位置+力	位置+力传感器	打磨、抛光、去毛刺

我个人建议：如果你刚开始接触力矩控制，先从阻抗控制入手。它不需要力传感器，实现起来相对简单。等你把阻抗控制玩熟了，再尝试导纳控制和力位混合控制。

小技巧：在实际调试时，先把刚度K设得很小（比如1 N/m），阻尼B设得适中（比如10 N·s/m），然后慢慢增加K，观察系统的响应。如果出现震荡，就增加B。这个方法我用了很多年，屡试不爽。

下面这张图展示了本章的知识体系结构，方便你理解三种控制策略之间的关系：

这张图把三种控制策略的核心逻辑、传感器需求和典型应用都串起来了。你可以把它当作一个快速参考，在实际项目中对照着选型。

好了，关于笛卡尔空间力矩控制，我就讲这么多。这三种策略我都用过，各有各的坑，也各有各的妙处。记住一点：没有最好的控制策略，只有最适合你任务的策略。多动手调试，多积累经验，你也能成为力矩控制的高手。

可可精品资料库