4. 力矩控制基础

六轴机械臂的力控能力，本质上取决于控制器对“力矩”这一物理量的处理方式。传统工业机器人普遍采用位置控制或速度控制，其核心假设是“机器人处于刚性、确定性的环境中”。然而，当机械臂需要执行打磨、装配、拖动示教或人机协作任务时，环境不再是刚性的，接触力成为必须主动管理的变量。力矩控制并非简单地“用力矩指令替代位置指令”，而是从控制架构、反馈通路到指令生成逻辑的全面重构。本章将深入剖析力矩控制与位置/速度控制的本质差异，拆解力矩环的典型结构，并讨论力矩指令的生成策略与反馈处理中的关键工程问题。

4.1 力矩控制与位置/速度控制的本质区别

4.1.1 核心原理：控制目标与控制架构的差异

位置控制的目标是让机械臂末端或关节精确到达指定位置，其内环为速度环，最内层为电流环（力矩环）。位置环的输出是速度指令，速度环的输出是电流指令，电流环最终驱动电机产生力矩。在这种级联结构中，力矩是位置误差的“副产品”——只有当位置出现偏差时，才会产生力矩来纠正偏差。速度控制类似，只是省略了位置环，直接以速度误差驱动电流。

力矩控制则完全不同：其最外层直接以力矩为控制目标，力矩环的输出是电流指令，而位置和速度变成了被动的结果。当机械臂末端与刚性环境接触时，力矩控制会限制接触力不超过设定值，即使位置尚未到达目标，也不会继续加大输出力矩。这种“力优先”的策略是柔顺操作的基础。

4.1.2 判断方法：如何识别控制模式

4.1.3 案例拆解：刚性位置控制导致过载

某3C装配线使用六轴机器人进行USB接口插拔测试。初始采用位置控制，机器人以0.5mm/s速度向下插入。由于连接器公差和定位误差，实际插入深度偏差0.3mm时，位置环仍持续输出力矩，导致连接器外壳破裂。将控制模式切换为力矩控制后，设定插入力矩上限为8N·m，当接触力矩达到阈值时，机器人自动停止下压并回退0.2mm，良率从82%提升至99.2%。

4.2 力矩环结构：从指令到执行的完整链路

4.2.1 核心原理：力矩环的层级与带宽分配

力矩环位于控制架构的中层，上承力矩指令生成模块，下接电流环。典型结构为：力矩指令 → 力矩误差计算 → 力矩控制器（PID/ADRC）→ 电流指令 → 电流环 → PWM → 电机 → 减速器 → 关节输出力矩。力矩环的采样频率通常为1kHz，而电流环为8-20kHz，这种带宽分配确保力矩环有足够的相位裕度。

力矩反馈来源有三种：关节力矩传感器（直接测量，精度高但成本高）、电机电流估计（通过电流与力矩常数换算，忽略摩擦和惯性）、六维力传感器（安装在末端，测量外部力/力矩）。工程中常将关节力矩传感器与电流估计结合，通过卡尔曼滤波融合。

4.2.2 操作流程：力矩环参数整定步骤

1. 开环标定：锁定机械臂，施加已知力矩，记录传感器读数，建立力矩-电压/电流标定曲线。
2. 电流环整定：确保电流环带宽足够（>5kHz），否则力矩环无法稳定。
3. 力矩环P增益初调：从较小P值开始，逐步增加至系统出现轻微振荡，然后回调30%。
4. 积分项补偿：加入积分项消除稳态误差，但需设置抗饱和限幅。
5. 微分项与滤波：微分项抑制超调，但会放大噪声，需配合低通滤波器（截止频率为力矩环带宽的3-5倍）。

4.2.3 案例拆解：打磨机器人力矩环调试

某卫浴五金打磨工作站，机器人末端安装气动打磨机，要求接触力稳定在25N±3N。初始力矩环P=0.8，I=0.05，实际接触力波动达±8N。分析发现，打磨机振动频率约30Hz，而力矩环带宽仅15Hz，无法有效抑制扰动。将力矩环带宽提升至50Hz（提高P至2.5，增加前馈补偿），接触力波动降至±2N。同时，在力矩反馈通道加入50Hz陷波滤波器，避免振动耦合。

4.3 力矩指令生成：从任务需求到力矩目标

4.3.1 核心原理：指令生成的三种模式

力矩指令并非简单的常数，而是根据任务动态生成。三种典型模式：

• 恒力模式：直接设定恒定力矩值，适用于打磨、抛光等恒压场景。
• 导纳/阻抗模式：根据位置偏差和速度偏差计算期望力矩，公式为 τ = K_p·Δx + K_d·Δv，模拟弹簧-阻尼系统。
• 力/位混合模式：在任务空间的不同方向分别采用位置控制和力矩控制，例如垂直方向恒力、水平方向位置跟踪。

4.3.2 操作流程：导纳参数设计

1. 确定目标刚度K_p：根据工件允许的最大变形量计算，例如允许0.5mm变形、最大力50N，则K_p=100N/mm。
2. 确定阻尼K_d：通常取K_d=2·ζ·√(K_p·M)，其中ζ=0.7-1.0，M为等效质量。
3. 设置力限幅：防止异常碰撞导致过载。
4. 加入前馈：对于已知重力负载，直接前馈补偿。

4.3.3 案例拆解：拖动示教中的力矩指令

协作机器人拖动示教要求操作者施加的力与机器人运动速度成比例。某工厂要求操作者以5N力拖动时，末端速度达到0.3m/s。采用导纳控制：K_p=0（无位置恢复），K_d=16.7 N·s/m（5N/0.3m/s）。实际调试中发现，操作者手部抖动导致速度波动，加入一阶低通滤波（截止频率5Hz）后，拖动平滑度显著提升。同时，在关节空间加入重力补偿前馈，使操作者无需额外用力克服自重。

4.4 力矩反馈处理：噪声、标定与补偿

4.4.1 核心原理：反馈链路中的三大挑战

力矩反馈的准确性直接决定控制性能。三大挑战：噪声（传感器电气噪声、机械振动耦合）、标定误差（温度漂移、安装预紧力）、动态补偿（重力、惯性力、摩擦力）。

重力补偿是力矩控制的基础。对于六轴机械臂，每个关节的力矩包含重力项：τ_g = Σ(m_i·g·r_i·cos(θ))，其中m_i为连杆质量，r_i为质心到关节的距离。实时计算需要精确的动力学模型和负载参数。

4.4.2 操作流程：力矩传感器标定与滤波

1. 零点标定：机器人处于零位，记录传感器输出，作为零点偏移。
2. 重力标定：让机器人依次运动到多个姿态，记录力矩值，通过最小二乘法辨识连杆质量和质心位置。
3. 温度补偿：在恒温箱中测试不同温度下的零点漂移，建立温度-偏移曲线。
4. 滤波策略：采用二阶巴特沃斯低通滤波器，截止频率设为力矩环带宽的2倍；对于特定频率的振动（如电机转速相关），使用陷波滤波器。

4.4.3 案例拆解：装配任务中的力矩反馈异常

某汽车零部件装配线，机器人进行轴承压装。力矩控制设定压装力为2000N，但实际压装过程中，力矩反馈出现周期性波动（±150N，频率12Hz）。排查发现，电机转速为720rpm（12Hz），减速器为谐波减速器，其柔性轮变形导致力矩波动。解决方案：在力矩反馈通道加入12Hz陷波滤波器，同时将力矩环带宽从30Hz降至20Hz，波动降至±30N。进一步分析发现，轴承与孔的同轴度偏差0.1mm导致侧向力，通过调整装配策略（先以位置控制找正，再切换力矩控制压装）彻底解决。

4.4.4 总结复盘：力矩控制落地的关键要点

力矩控制的核心在于“让力成为主动变量，而非被动结果”。从控制架构看，它改变了级联结构中的主导反馈量；从工程实现看，它要求更精确的建模、更干净的反馈信号和更合理的带宽分配。掌握力矩环的结构与调试方法，是迈向柔顺操作的第一步。在实际项目中，建议从简单的恒力打磨场景入手，积累力矩环整定经验，再逐步扩展到复杂的力/位混合任务。