第四章：阻抗控制入门

各位同学，欢迎来到第四章。前面几章我们讲了力矩控制的基本概念，今天我们来聊聊一个非常实用的东西——阻抗控制。

说实话，我第一次接触阻抗控制时，觉得这名字起得挺唬人的。什么「阻抗」？又不是电路。后来做项目做多了才明白，这玩意儿说白了就是——让机器人学会「顺从」。

4.1 阻抗控制的概念

先问大家一个问题：你让机器人去推一堵墙，会发生什么？

如果用的是纯位置控制，机器人会拼命往墙里钻，直到电机过载或者撞坏东西。这显然不行。

那如果换成纯力矩控制呢？机器人倒是温柔了，但让它精确走到某个位置，它又做不到。

阻抗控制就是来解决这个矛盾的。它的核心思想是：把机器人末端的行为，模拟成一个质量-弹簧-阻尼系统。

这个公式看着复杂，其实意思很简单：你推它，它就动；你推多大力，它就动多少距离。就像推一个弹簧一样自然。

我个人习惯把阻抗控制分成两类：

• 基于位置的阻抗控制：输入是力，输出是位置修正量
• 基于力的阻抗控制：输入是位置偏差，输出是力矩指令

实际项目中，我用的最多的是第一种。为什么？因为大多数工业机器人本身就有很好的位置控制接口，我们只需要在外部加一层阻抗计算就行。

4.2 质量-弹簧-阻尼模型

这个模型是阻抗控制的灵魂。你想想看，一个弹簧被压缩时会产生反力，一个阻尼器被拉伸时会产生阻力，一个质量块被加速时会产生惯性力。把它们组合起来，就能模拟出各种机械行为。

我给大家画个图，方便理解：

这个模型告诉我们三件事：

• 刚度 K：决定了位置偏差和力的比例。K 越大，机器人越「硬」
• 阻尼 B：决定了速度相关的阻力。B 越大，运动越「粘」
• 惯性 M：决定了加速度相关的力。M 越大，越「笨重」

4.3 目标阻抗参数设计

参数设计这块，我踩过不少坑。给大家说说我的心得。

第一步：确定刚度 K

刚度决定了机器人的「顺从程度」。举个例子：

• 装配精密轴承：K = 500 ~ 2000 N/m（要柔）
• 拧螺丝：K = 5000 ~ 20000 N/m（要刚）
• 抛光打磨：K = 1000 ~ 5000 N/m（适中）

第二步：确定阻尼 B

阻尼的选择有个经验公式：

B = 2 * ζ * sqrt(M * K)

其中 ζ 是阻尼比：
  ζ < 1：欠阻尼（会震荡）
  ζ = 1：临界阻尼（最快稳定）
  ζ > 1：过阻尼（响应慢）

我个人习惯取 ζ = 0.7 ~ 1.0。为什么？因为临界阻尼虽然响应快，但稍微有点扰动就容易超调。0.7 左右是个安全值。

第三步：确定惯性 M

这里有个容易犯的错误——很多人直接把机器人末端质量填进去。其实不对。

M 应该取 机器人末端等效质量 + 负载质量。而且这个等效质量是随姿态变化的。我在做焊接机器人项目时，就因为这个吃了亏——同一个参数，在某个姿态下好好的，换个姿态就开始抖。

4.4 力与位置的关系

理解了参数设计，我们来看看实际中力与位置是怎么互动的。

假设你让机器人去推一个弹簧：

• 如果弹簧很软（K 小），机器人稍微动一点，力就很大
• 如果弹簧很硬（K 大），机器人需要动很多，力才明显

这就是阻抗控制的核心——通过调整阻抗参数，改变力与位置的映射关系。

我给大家看一段实际代码，这是我做力控装配时用的：

// 阻抗控制核心算法
void impedanceControl(float x_des, float x_act, float v_des, float v_act, float f_ext) {
    // 位置偏差
    float dx = x_des - x_act;
    float dv = v_des - v_act;
    
    // 计算期望力
    float f_des = K * dx + B * dv;
    
    // 考虑外部力（比如接触力）
    float f_cmd = f_des - f_ext;
    
    // 限幅保护
    if (f_cmd > F_MAX) f_cmd = F_MAX;
    if (f_cmd < -F_MAX) f_cmd = -F_MAX;
    
    // 输出力矩指令
    setMotorTorque(f_cmd);
}

这段代码看着简单，但实际用起来要注意几点：

• 力传感器噪声：我一般会加个低通滤波，截止频率 10-20Hz
• 接触检测：当力突然增大时，说明接触到了，要切换控制模式
• 安全限幅：力矩指令一定要限幅，不然电机可能烧掉

好了，这一章的内容就到这里。阻抗控制是个很实用的技术，我建议大家在仿真环境里多试试，把参数调一遍，感受一下不同参数带来的变化。只有亲手调过，才能真正理解。

记住一句话：阻抗控制不是让机器人变弱，而是让它变聪明。