1. 课程导入
关节电机是机器人执行器中最关键的部件之一。无论是协作机械臂、四足机器人，还是人形机器人的髋、膝、踝关节，其运动品质最终都取决于电机能否在任意时刻输出准确、平滑、可重复的力矩。本课程围绕磁场定向控制（FOC）与力矩控制两条主线展开，帮助学习者从电机本体、功率变换、电流环、位置环，一路走到关节柔顺控制与工程落地。
一、学习目标：从“会转”到“会用力”
很多初学者第一次驱动关节电机时，只关心“电机能不能转起来”。但在机器人场景中，真正重要的是：给定一个目标力矩，电机能否在毫秒级时间内稳定输出，并且在低速、换向、堵转、外部扰动下都不抖动、不啸叫、不失控。因此本课程的学习目标分为四个层次：
- 理解层：掌握FOC的坐标变换、电流环、速度环、位置环的基本原理，理解d-q轴电流与力矩的物理关系。
- 实现层：能够配置PWM、ADC采样、编码器/霍尔接口，完成电流环闭环与参数整定。
- 控制层：理解力矩控制、阻抗控制、导纳控制的区别，能够根据关节需求选择合适的控制模式。
- 工程层：掌握温升、母线电压、死区、采样噪声、机械谐振等实际问题的排查与优化方法。
核心判断：一个关节电机系统是否合格，不看空载转速，而看它在额定力矩、低速、频繁换向时，电流波形是否仍然接近正弦，力矩纹波是否足够小。
二、核心概念：FOC与力矩控制的关系
FOC的本质，是把三相电流通过Clarke变换和Park变换，投影到随转子旋转的d-q坐标系中。d轴电流通常用于弱磁或励磁，q轴电流则直接对应力矩输出。对于表贴式永磁同步电机，力矩近似为：
T = (3/2) * p * λm * iq
其中：
p = 极对数
λm = 永磁体磁链
iq = q轴电流这意味着，只要控制好iq，就能控制力矩。但“控制好”三个字背后，包含电流采样时序、PWM死区补偿、编码器对齐、电流环带宽、母线电压利用率等一系列工程问题。力矩控制则是FOC的上层目标：它要求电流环不仅稳定，还要快速、线性、低纹波，并且能够接受上层位置环或力传感器的指令。
下图展示了从电源到关节力矩输出的完整信号链与能量流关系，帮助建立整体框架认知。
三、方法流程：从电流环到关节力矩的工程路径
工程实现通常遵循“先电流环、再速度环、后位置环与力控”的顺序。电流环是内环，带宽最高，决定力矩响应速度；速度环和位置环是外环，带宽依次降低。若顺序颠倒，外环参数无法稳定。典型调试流程如下：
- 电机参数辨识：测量相电阻、相电感、永磁磁链、极对数。
- 编码器对齐：确定电角度零点，保证Park变换角度正确。
- 电流环整定：先调d轴，再调q轴，观察阶跃响应与超调。
- 力矩线性度测试：给定不同iq，测量实际输出力矩，检查死区与饱和。
- 速度/位置环整定：在电流环稳定基础上逐级闭合。
- 柔顺控制接入：引入阻抗或导纳模型，验证接触稳定性。
经验提示：如果电流波形在过零附近出现明显畸变，优先检查死区补偿和电流采样时刻，而不是反复调整PID参数。
四、典型应用场景与常见误区
关节电机FOC与力矩控制广泛应用于协作机器人、人形机器人、四足机器人、外骨骼、电动夹爪和精密转台。不同场景对控制的要求差异很大：协作机器人强调安全柔顺与碰撞检测；人形机器人强调高力矩密度与动态响应；外骨骼强调低速平稳与穿戴舒适性。
| 应用场景 | 核心需求 | 控制重点 | 常见问题 |
|---|---|---|---|
| 协作机械臂 | 安全、柔顺、碰撞检测 | 力矩控制 + 阻抗控制 | 低速爬行、力矩纹波 |
| 人形机器人关节 | 高力矩密度、动态响应 | 高带宽电流环 + 位置环 | 温升、母线跌落 |
| 四足机器人 | 抗冲击、快速换向 | 力矩前馈 + 柔顺落地 | 机械谐振、编码器噪声 |
| 外骨骼 | 低速平稳、穿戴舒适 | 导纳控制 + 力矩限幅 | 死区导致起步顿挫 |
| 电动夹爪 | 力控抓取、成本敏感 | 电流环力矩估计 | 无传感器力矩精度不足 |
常见误区：一是把FOC等同于“能转就行”，忽视电流环带宽与采样时序；二是只调PID，不检查编码器对齐和死区；三是把力矩控制简单理解为“给iq”，忽略温度、磁饱和和母线电压波动对力矩常数的影响；四是在没有电流环稳定的前提下直接上力控，导致系统振荡甚至损坏减速器。
本课程后续将沿着“电机与功率级 → 电流采样与坐标变换 → 电流环整定 → 速度与位置环 → 力矩估计与力控 → 关节柔顺与工程排障”的路径逐步展开。掌握这条主线，才能在真实关节系统中把FOC从理论变成可重复、可量产、可维护的力矩控制能力。