3. 关节传动与传感器
机器人关节的力控与FOC（磁场定向控制）性能，本质上取决于传动机构与传感器系统的物理品质与信号质量。谐波减速器与行星减速器决定了关节的刚度、背隙与力矩密度；编码器、电流传感器与力矩传感器则构成了FOC电流环、速度环和力控外环的感知基础。本章将深入剖析这五类核心部件的机械原理、电气接口与工程选型要点，并重点讨论传感器信号链路的噪声抑制与标定方法，为后续的FOC算法与柔顺控制实战打下硬件基础。
3.1 谐波减速器与行星减速器：传动原理与选型对比
核心原理
谐波减速器由波发生器、柔轮和刚轮三大核心部件构成。波发生器呈椭圆形，装入柔轮后迫使柔轮产生弹性变形，柔轮外齿与刚轮内齿在椭圆长轴两端啮合，短轴两端完全脱开。当波发生器旋转时，柔轮与刚轮的齿差（通常为2齿）导致柔轮以极低速度反向旋转，从而实现大减速比。以减速比100为例，电机每转100圈，输出轴仅转1圈，且扭矩放大100倍（忽略效率损失）。谐波减速器的核心优势在于：单级减速比可达50~160、零背隙（弹性预紧）、结构紧凑、重量轻，非常适合协作机器人与精密关节。
行星减速器则采用太阳轮、行星轮、内齿圈和行星架的结构。太阳轮输入动力，行星轮同时与太阳轮和内齿圈啮合，行星架输出动力。减速比由齿数比决定，典型范围为3~100。行星减速器具有高刚度、高效率（单级可达97%以上）、抗冲击能力强等特点，但存在固有背隙（通常3~10 arcmin），需要通过预紧或双电机消隙方案改善。
选型对比与判断方法
| 性能维度 | 谐波减速器 | 行星减速器 |
|---|---|---|
| 减速比范围 | 50~160（单级） | 3~100（多级组合） |
| 背隙 | 零背隙（<1 arcmin） | 3~10 arcmin（标准级） |
| 传动效率 | 70%~85% | 90%~97% |
| 扭转刚度 | 中等（柔轮弹性） | 高（刚性齿轮） |
| 重量/体积 | 轻巧紧凑 | 相对较重 |
| 适用场景 | 协作臂、医疗机器人、精密转台 | 重载工业臂、AGV驱动、关节模组 |
| 失效模式 | 柔轮疲劳断裂 | 齿轮点蚀、断齿 |
选型时需综合考量关节的峰值扭矩、额定转速、精度要求与成本预算。对于需要力控柔顺的协作机器人关节，谐波减速器的零背隙特性是力控精度的基础；而对于重载搬运场景，行星减速器的高刚度和高效率更具优势。
3.2 编码器：位置感知与接口协议
核心原理与分类
编码器是关节电机控制中位置环和速度环的感知核心。按工作原理可分为光电式、磁式和容栅式三类。光电编码器通过码盘上的透光/遮光条纹产生正交信号，精度最高（可达17~23位），但对污染和振动敏感；磁编码器利用磁阻或霍尔效应检测磁极旋转角度，抗污染能力强、成本低，精度通常为12~16位；容栅编码器通过电容变化检测位移，兼具精度与鲁棒性，但成本较高。
按输出信号类型，编码器又分为增量式（ABZ正交信号）和式（SSI、BiSS-C、SPI等协议）。增量式编码器需要上电寻零，而式编码器上电即可读取位置，这对于需要断电保持位置记忆的机器人关节至关重要。
接口与信号处理
// 典型式编码器BiSS-C读取时序（以24位单圈为例）
// SLO线：时钟输入，MA线：数据输出
// 初始化序列：至少持续25个时钟周期的低电平唤醒
// 数据帧：ACK(1bit) + 错误位(1bit) + 位置数据(24bit) + CRC(6bit)
uint32_t read_biss_c_position(void) {
uint32_t position = 0;
// 1. 发送唤醒序列
for (int i = 0; i < 25; i++) {
SLO_LOW();
delay_us(1);
SLO_HIGH();
delay_us(1);
}
// 2. 读取数据帧
// ... 具体时序实现
return position;
}在FOC控制中，编码器数据通常通过SPI或BiSS-C接口以1kHz~10kHz的速率读取。对于高动态响应的关节，建议使用BiSS-C或SSI等同步串行协议，以保证数据采样的确定性。编码器信号线必须采用屏蔽双绞线，并与电源线保持至少10mm间距，避免PWM逆变器的高频噪声耦合。
3.3 电流传感器：FOC电流环的感知基础
核心原理与采样方式
FOC算法需要精确获取电机三相电流（通常采样两相即可，第三相通过基尔霍夫定律计算）。电流传感器主要有三种实现方式：采样电阻+运放、霍尔电流传感器、以及磁通门传感器。采样电阻方案成本低、线性度好，但存在功率损耗且需要隔离；霍尔传感器实现电气隔离，但存在温漂和带宽限制；磁通门传感器精度最高，但成本昂贵。
在机器人关节驱动器中，最常用的是低阻值采样电阻（如10mΩ~50mΩ）配合差分放大器，在PWM中心对齐时刻同步采样。采样时刻必须避开开关管的开关瞬态，通常选择PWM周期的中点或边沿对齐时刻。
采样链路设计与标定
// 电流采样链路参数示例
// 采样电阻：R_shunt = 10mΩ ±1%
// 放大器增益：G = 50（INA240或AD8418）
// ADC参考电压：V_ref = 3.3V
// 满量程电流：I_max = V_ref / (R_shunt * G) = 3.3 / (0.01 * 50) = 6.6A
// 偏置电压：V_offset = V_ref / 2 = 1.65V（双极性测量）
// 电流计算代码
float current_phase_a = (adc_value * 3.3f / 4096.0f - 1.65f) / (0.01f * 50.0f);电流采样链路需要定期校准，以消除运放失调电压和采样电阻温漂的影响。推荐在电机静止时进行零点校准，并在恒温环境下进行增益校准。对于高精度力控应用，建议使用双采样电阻方案（两相各一个），避免单电阻采样在低调制比时的盲区问题。
3.4 力矩传感器：力控柔顺的感知核心
核心原理与类型
力矩传感器用于直接测量关节输出扭矩，是实现高精度力控/柔顺控制的关键。常见类型包括：应变片式力矩传感器、磁致伸缩式、以及基于编码器+电流估算的间接力矩观测。应变片式传感器通过粘贴在弹性体上的应变片检测微应变，经惠斯通电桥转换为电压信号，精度高、响应快（带宽可达1kHz以上），但成本较高且过载能力有限。
在关节模组中，力矩传感器通常安装在减速器输出端与负载之间，直接感知外部交互力矩。对于协作机器人，力矩传感器需要具备高过载保护（通常为额定值的3~5倍）和良好的温度补偿性能。
标定与温度补偿
力矩传感器在出厂前需进行多轴标定，包括：零漂校准、灵敏度标定、温度漂移补偿和交叉耦合补偿。实际使用中，建议在关节上电后执行一次静态零位校准，并在运行过程中周期性检查零漂。温度补偿通常采用内置温度传感器配合多项式拟合算法，补偿系数需在温箱中实测获取。
某协作机器人关节采用应变片式力矩传感器，额定扭矩50Nm，过载能力200%。初始现象：在恒温环境下零漂小于0.1%FS，但整机运行30分钟后，零漂增大至0.8%FS，导致力控精度下降。
分析过程：通过监控传感器内置温度数据，发现关节内部温度从25℃升至65℃，温漂系数约为0.015%FS/℃。进一步检查发现，传感器弹性体与减速器输出法兰之间的安装面存在微小间隙，导致热膨胀时产生附加应力。
解决步骤：1）重新设计安装法兰，增加0.02mm的过盈配合；2）在传感器信号调理电路中增加二阶温度补偿网络；3）在固件中增加基于温度查表的零漂修正算法。
结果对比：补偿后，在65℃工况下零漂降至0.15%FS以内，力控精度提升约5倍。该案例表明，力矩传感器的温度补偿不仅依赖电路设计，还需关注机械安装的热应力路径。
3.5 传感器融合与信号完整性设计
多传感器数据融合策略
现代机器人关节通常同时配备编码器、电流传感器和力矩传感器。在FOC控制中，电流环使用电流传感器数据（带宽10kHz以上）；速度环使用编码器差分数据（带宽1kHz）；力控外环则融合力矩传感器与电流估算值（带宽100Hz~500Hz）。传感器融合的关键在于时间同步——所有传感器数据必须带有统一的时间戳，否则相位延迟会导致控制环路不稳定。
信号完整性设计要点
- 地平面分割：模拟地与数字地在ADC芯片处单点连接，避免数字噪声串入模拟采样链路。
- 电源去耦：每个传感器芯片的电源引脚需放置100nF+4.7uF去耦电容，且尽量靠近芯片。
- 屏蔽与接地：编码器线缆采用屏蔽双绞线，屏蔽层单端接地（控制器侧），避免地环路。
- ADC采样时序：电流采样必须与PWM同步，建议使用硬件触发ADC，避免软件延时抖动。
常见误区与总结复盘
| 误区 | 后果 | 正确做法 |
|---|---|---|
| 忽略编码器线缆屏蔽 | 位置跳变、FOC振荡 | 使用屏蔽双绞线，单端接地 |
| 电流采样时刻不当 | 电流波形畸变、噪声大 | PWM中心对齐采样，硬件触发 |
| 力矩传感器未做温度补偿 | 零漂大、力控精度差 | 内置温度传感器+多项式补偿 |
| 减速器选型只看减速比 | 刚度不足或背隙过大 | 综合评估刚度、背隙、效率 |
| 传感器数据未时间同步 | 控制环路相位裕度不足 | 统一时间戳，硬件同步采样 |
本章系统梳理了机器人关节传动与传感器的核心原理与工程接口。在实际项目开发中，建议先根据关节的力控精度目标（如力矩纹波<1%FS）反推传感器精度需求，再确定减速器类型与编码器分辨率。硬件设计完成后，务必进行完整的信号质量测试（包括频谱分析、温漂测试和EMC预测试），确保传感器数据在恶劣电磁环境下依然可靠。