1. 课程导论
六轴机械臂的力矩控制与柔顺操作，是机器人学从“位置精确运动”迈向“物理交互智能”的关键技术分水岭。传统工业机械臂在装配、打磨、插拔等任务中，往往因刚性位置控制而面临过大的接触力，导致工件损伤或设备故障。力矩控制的核心在于让机械臂能够感知并主动调节关节或末端所受的外力/力矩，而柔顺操作则是在此基础上实现机械臂对环境约束的主动或被动顺应。本课程将系统性地拆解这一技术体系，从底层动力学原理到上层控制算法，再到工业级实战案例，帮助学习者建立完整的知识框架与工程直觉。
上图勾勒了本课程的核心知识框架。力矩控制是感知与执行的基础，柔顺操作是策略与目标，而应用领域则决定了技术选型与性能指标。课程将围绕这一框架，从理论推导到代码实现，再到真实产线案例，层层递进。
一、核心原理：从刚性控制到柔顺交互
六轴机械臂的传统控制方式为位置控制，即通过PID等算法驱动各关节电机，使末端执行器精确跟踪笛卡尔空间中的目标轨迹。这种控制方式在“自由空间”运动中表现优异，但在接触环境时，由于机械臂的高刚性和位置误差，会产生巨大的接触力。例如，在轴孔装配中，若轴与孔的中心偏差仅0.1mm，刚性位置控制可能产生数百牛顿的横向力，导致卡死或工件划伤。
力矩控制改变了这一范式。其核心思想是：将关节力矩作为被控变量，而非仅仅作为位置环的输出。具体而言，机械臂的动力学方程可表示为：
M(q)q̈ + C(q,q̇)q̇ + G(q) + τ_f = τ_m + τ_ext其中，M(q)为惯性矩阵，C(q,q̇)为科氏力和离心力项，G(q)为重力项，τ_f为摩擦力矩，τ_m为电机输出力矩，τ_ext为外部环境施加的力矩。力矩控制的目标是：通过精确补偿M、C、G、τ_f，使得τ_m能够直接响应期望的交互力矩τ_ext，或通过调整τ_m来模拟期望的机械阻抗（如弹簧-阻尼特性）。
柔顺操作则是力矩控制的上层策略。它定义了机械臂在受到外力时如何“让步”。最常见的两种实现方式为：
- 阻抗控制：不直接控制力，而是控制位置与力的动态关系。通过设定目标刚度K_d、阻尼B_d和惯性M_d，使机械臂表现为一个质量-弹簧-阻尼系统。当外力F_ext作用于末端时，位置偏差Δx满足：M_d Δẍ + B_d Δẋ + K_d Δx = F_ext。
- 导纳控制：基于外部力传感器测量F_ext，通过计算期望的位置修正量Δx，再交由底层位置控制器执行。导纳控制更适合于位置控制精度高的现有机器人平台。
二、判断方法与操作流程：如何选择控制策略
面对实际任务，工程师需要根据任务约束和硬件条件选择最合适的柔顺策略。以下是判断流程：
- 任务约束分析：任务是否需要精确的力跟踪（如打磨、抛光）？还是仅需要避免过大接触力（如装配、插拔）？前者适合阻抗控制，后者适合导纳控制或简单的力/位混合控制。
- 硬件能力评估：机械臂是否具备关节力矩传感器？如果没有，是否可以通过电流环估算力矩？电流环估算精度通常较低（误差5-10%），且无法感知外部冲击力矩。若需要高精度力控，必须加装末端六维力/力矩传感器。
- 环境刚度估计：接触环境是刚性（如钢制工件）还是柔性（如海绵、人体组织）？环境刚度越高，控制器的稳定性裕度越小，需要更保守的阻抗参数。
- 控制频率与延迟：力矩控制环通常需要1kHz以上的控制频率，而导纳控制若基于外部传感器，延迟需控制在2ms以内，否则易产生振荡。
| 对比维度 | 阻抗控制 | 导纳控制 | 力/位混合控制 |
|---|---|---|---|
| 控制变量 | 位置偏差与力的动态关系 | 外力→位置修正 | 在约束方向控力，自由方向控位 |
| 传感器需求 | 关节力矩传感器（或电流估算） | 末端六维力传感器 | 力传感器+位置编码器 |
| 环境适应性 | 对环境刚度变化敏感 | 对环境刚度变化鲁棒 | 需精确知道约束方向 |
| 典型应用 | 精密装配、抛光 | 人机协作、拖动示教 | 曲面跟踪、去毛刺 |
| 实现难度 | 高（需精确动力学模型） | 中（依赖传感器质量） | 高（需任务规划） |
三、案例拆解：工业装配中的柔顺插拔
以某汽车零部件产线的齿轮轴装配任务为例，该任务要求将直径20mm的齿轮轴插入带有0.02mm过盈量的轴承孔中。传统位置控制下，由于视觉定位误差（±0.3mm）和夹具偏差，插入成功率仅为65%，且频繁出现轴表面划伤。
初始目标与约束：将插入成功率提升至99%以上，且最大接触力不超过50N（防止齿轮变形）。产线节拍要求单次装配时间不超过3秒。
关键输入数据：
- 机械臂：六轴工业机器人，重复定位精度±0.02mm，控制周期1ms。
- 传感器：末端安装六维力/力矩传感器（量程200N，分辨率0.1N）。
- 环境刚度：轴承座为铸铁，刚度约10^6 N/m。
分析判断过程：由于存在过盈量，装配过程必然产生接触力。若采用纯位置控制，微小偏差会导致力急剧上升。采用导纳控制，设定目标刚度K_d=500N/m，阻尼B_d=50Ns/m，即当接触力达到10N时，允许位置偏差20mm（实际受限于装配行程）。但过大的位置偏差会导致轴歪斜，因此需要结合力/位混合策略：在轴向（Z方向）采用力控制，保持恒定进给力30N；在径向（X/Y方向）采用导纳控制，允许微小偏移以自动找正。
实际操作步骤：
- 在机器人控制器中编写导纳控制算法，采样频率1kHz，滤波截止频率50Hz。
- 设置力控轴向目标力30N，力误差容忍±5N。
- 设置径向导纳参数：K_d=800N/m，B_d=80Ns/m，最大偏移量±1mm。
- 编写状态机：搜索阶段（径向导纳）→ 插入阶段（轴向力控+径向导纳）→ 到位检测（轴向力突增）。
- 在仿真环境中验证参数，再部署到实际产线。
结果对比：采用柔顺控制后，插入成功率提升至99.6%，最大接触力稳定在42N±8N，单次装配时间2.8秒。轴表面划伤率从12%降至0.3%。
风险与代价：导纳控制依赖力传感器精度，若传感器温漂过大，会导致力控偏差。此外，径向偏移量限制过小时，可能无法补偿较大的初始位置误差。为此，在产线中增加了视觉引导预对准，将初始误差缩小至±0.1mm。
四、常见误区与总结复盘
在力矩控制与柔顺操作的学习和工程应用中，以下误区最为常见：
- 误区一：认为力矩控制就是“软”。实际上，力矩控制可以做到比位置控制更“硬”的刚度（通过高增益力矩环），关键在于控制带宽和稳定性。
- 误区二：忽略动力学模型的重要性。许多初学者直接套用阻抗控制公式，却不进行重力/摩擦力补偿，导致机械臂在低速时抖动，在高速时失控。
- 误区三：传感器选型不当。使用低精度电流环估算力矩进行精密装配，结果力控误差超过任务允许范围。电流环适合粗略的碰撞检测，不适合精密力控。
- 误区四：参数调试无章法。阻抗参数（K_d、B_d）的调试应遵循“先刚度后阻尼”的原则，且需要根据环境刚度调整。若环境刚度高，K_d应调低；若系统出现振荡，应增大B_d。