一、力矩控制基础

什么是力矩控制？

力矩控制，说白了就是让机器人「感知力的大小」。

传统的机器人控制，我们告诉电机「转多少角度」或者「转多快」。但力矩控制不一样——我们告诉电机「输出多大的力」。这就像你用手去推一扇门：位置控制是「推30度角」，速度控制是「每秒推10度」，而力矩控制是「用5牛顿的力去推」。

我刚开始接触这个概念时，也觉得有点绕。后来在调试一台协作机器人时，才真正体会到它的价值。当时机器人要抓取一个易碎的玻璃杯，位置控制根本不行——稍微偏差一点，杯子就碎了。换成力矩控制后，机器人能「感觉」到接触力，自动调整，稳稳地拿起来。

力矩控制 vs 位置/速度控制

这三者的区别，我用一个表格来说明，你一看就明白：

控制方式	控制目标	反馈信号	典型应用
位置控制	关节角度/末端位置	编码器	点焊、搬运
速度控制	关节角速度/线速度	编码器+微分	传送带跟踪
力矩控制	关节力矩/接触力	电流传感器/力传感器	力控打磨、装配

嗯，这里有个关键点：位置控制和速度控制都是「刚性」的——你设定一个值，机器人就拼命去达到。而力矩控制是「柔性」的——它允许机器人顺应外部力。

我曾经在调试一个力控打磨项目时，遇到过这样的问题：用位置控制去打磨曲面，结果工件表面有0.5mm的误差，机器人就硬生生地压过去，把工件磨坏了。换成力矩控制后，机器人会「顺着」曲面走，始终保持恒定的接触力，效果立竿见影。

应用场景

协作机器人

协作机器人为什么能和人安全地一起工作？说白了，就是因为它有力矩控制。

你想想看，如果一台机器人只有位置控制，你推它，它会跟你「较劲」——因为它的目标是保持位置不变。但协作机器人有力矩控制，你推它时，它会检测到外力，然后「顺从」地让开。

我记得有一次在展会上，看到一台协作机器人被一个小朋友推了一下，它立刻停下来，还发出了「碰撞检测」的信号。这就是力矩控制在起作用。

协作机器人中力矩控制的典型应用：

• 拖动示教：操作者直接拉着机器人手臂移动，机器人记录轨迹。这需要力矩控制让机器人处于「零力」状态。
• 碰撞检测：当机器人碰到人或障碍物时，力矩突变，系统立即停止或回退。
• 力位混合控制：在某些方向用力矩控制，在另一些方向用位置控制。比如拧螺丝时，旋转方向用力矩控制，轴向用位置控制。

力控打磨

力控打磨是力矩控制最典型的工业应用之一。我做过好几个打磨项目，这里分享一些经验。

打磨的难点在于：工件表面不是完美的平面，有0.1-0.5mm的起伏。如果用位置控制，机器人会「硬压」下去，导致打磨不均匀，甚至损坏工件。

力矩控制的思路是：

1. 设定一个目标接触力（比如10N）
2. 机器人带着打磨工具靠近工件
3. 一旦接触，力矩控制器调节位置，保持接触力恒定
4. 机器人沿着工件表面移动，力始终不变

下面是一个简单的力控打磨控制流程图：

这个图展示了力控打磨的核心逻辑。外环是力矩控制，内环是位置控制。说白了，就是「用力矩控制决定怎么走，用位置控制去执行」。

力矩控制的实现方式

实际工程中，力矩控制主要有两种实现方式：

• 基于电流环：利用电机电流与力矩成正比的关系，通过控制电流来控制力矩。成本低，但精度一般，受摩擦力影响大。
• 基于力传感器：在机器人末端或关节安装力传感器，直接测量接触力。精度高，但成本高，传感器有噪声。

我个人的习惯是：如果只是做简单的碰撞检测或拖动示教，用电流环就够了。但如果是精密打磨或装配，必须上力传感器。

下面是一个简单的力矩控制伪代码：

// 力矩控制主循环
while (running) {
    // 读取目标力矩
    tau_des = get_desired_torque();
    
    // 读取实际力矩（来自电流或传感器）
    tau_fb = get_feedback_torque();
    
    // 计算误差
    error = tau_des - tau_fb;
    
    // PID控制器
    integral += error * dt;
    derivative = (error - prev_error) / dt;
    tau_cmd = Kp * error + Ki * integral + Kd * derivative;
    
    // 输出到电机
    set_motor_current(tau_cmd);
    
    prev_error = error;
    delay(dt);
}

这段代码看起来简单，但实际调试时坑很多。比如积分饱和问题——如果机器人被卡住，积分项会一直累积，一旦释放，机器人会猛地冲出去。我建议加上积分限幅和抗饱和处理。

好了，关于力矩控制的基础就讲到这里。记住三个关键词：力感知、柔顺性、恒力控制。下一节我们会深入讲阻抗控制，那是力矩控制的高级玩法。

可可精品资料库