上个月在调试一台六轴协作机器人J1轴的时候我在速度环扫频里看到一段明显的毛刺大概30Hz左右总有一个小鼓包。换回纯光电编码器测问题消失但客户说光编成本扛不住又怕现场油雾和振动把它搞坏。后来我把磁编码器和一个带RDC解码的旋变传感器做了双通道融合毛刺没了成本也压回去了。这不是什么新鲜招这两年国产机器人关节模块里“磁编码器 RDC位置传感器”这个组合出现得越来越多尤其在谐波一体化关节和直驱关节上。这篇文章不聊虚的就用实际调试经历说说这套组合到底解决了什么问题以及怎么把它调稳。1. 关节反馈这件事为什么卡在选型上1.1 机器人关节对反馈到底要求什么工业机器人的关节反馈不是单纯“转了多少度”那么简单。位置环需要绝对角速度环需要低延时的角速度电流环还需要知道准确的换相角。一台6轴机器人J1到J6对反馈的需求还有差异基座轴扭矩大、惯量大J6末端转速高、结构紧凑。拆开看关节反馈要同时满足这几件事绝对位置机器人开机不能每次都找零所以要么是多圈绝对值编码器要么是单圈绝对值加掉电记忆。低延迟速度环和电流环一般跑到10kHz以上位置数据从传感器到MCU的延迟超过几十微秒就会影响相角裕量。抗污染和抗振动关节里是油脂、谐波减速器、刹车碎片VI外还有驱动线缆的电磁干扰。温度稳定性机器人关节内部温度轻松到七八十度编码器零点漂移会导致重复定位精度变差。成本这是最现实的一条。一台六轴机器人有6个关节反馈传感器成本直接翻倍就非常可观。所以“选型困局”是真实存在的单个传感器很难同时把绝对位置、高带宽、高可靠、低价格都占满。1.2 光编、磁编、旋变各有各的活法传统方案里光电编码器是精度标杆。17位单圈、23位多圈的光电绝对值编码器分辨率确实漂亮但它有玻璃码盘和LED怕震动、怕油污、怕温度骤变。现场跑两年码盘进油精度就可能逐步劣化。而且多圈光编内部有减速齿轮和电池电池没电就丢绝对位置。磁编码器是近十年的平民英雄。它靠检测磁钢的磁场方向不做光学测量所以不怕油污体积小还很便宜。AS5047P、MT6701这样的芯片单圈14位分辨率输出ABZ、SPI、I2C、UVW直接给MCU用后端电路也简单。但它的问题是“绝对精度”一般芯片标称的INL可能到0.3度以上需要通过校准手段往0.05度以下压。旋变Resolver加RDC数字转换器的路线看起来是“老派做法”。旋变本体就是一个微型变压器转子和定子之间有气隙没有电子元器件特别耐温耐振寿命长。RDC芯片负责把正余弦模拟信号变成数字角度。这套组合的问题是成本偏高、需要激励电路、模数混合设计麻烦过去主要用在航空、军工和高端伺服上。这三种传感器的核心矛盾在于光编精度高但娇气磁编便宜实测但精度和温漂让人不放心旋变可靠但成本和体积高。1.3 组合方案为什么突然流行“磁编码器 RDC位置传感器”的流行本质上是行业从“一个传感器打天下”转向“两个传感器互补”。原因很简单现在的机器人对安全性和动态性能要求越来越高。协作机器人要求力矩闭环和碰撞检测这就需要低速时速度反馈平滑工业机器人在追求节拍时又需要高带宽。单一磁编码器容易在低速出现量化噪声单一旋变加RDC虽然平滑但跟踪环有相位滞后高速时带宽又不够。于是就有了很自然的组合磁编码器管速度、管换相负责“快”旋变RDC管绝对位置、管长期稳定负责“准”。两者各取所长还能互为备份成本比光编多圈方案低可靠性却比单磁编高一个量级。加上现在RDC芯片国产化之后价格下来了这个方案自然就被越来越多关节模块采用。2. 磁编码器和RDC到底怎么配合干活2.1 磁编码器的“快”是天生的以MT6701这类磁角度传感器为例它内部是一个基于TMR或者AMR的惠斯通桥感应磁钢的轴向磁场方向通过CORDIC算法直接算角度输出。因为磁场信号到角度的转换是连续的没有码盘增量计数过程所以它的带宽非常高响应延迟通常在微秒级。实际使用里我更喜欢把磁编码器的ABZ信号直接接到MCU的QEP正交解码器上用它的高频率变化来测速。这样速度环能拿到非常实时的角速度反馈不容易产生相位滞后。磁编码器输出的UVW信号还能直接当电机换相信号用省掉一个霍尔板这对小型关节的电机控制特别重要。但磁编码器有个天生短板它的原始正弦余弦幅值不理想容易受放大器和PCB布局影响导致角度误差带上一次、二次谐波。如果磁钢安装偏心误差还会更明显。所以磁编码器适合“高频但不需要极准”的速度环不适合直接当机器人的绝对位置基准。2.2 RDC的“稳”是怎么炼成的旋变本体是个旋转变压器初级线圈通10kHz左右的正弦激励次级输出两路正余弦包络幅值比例就是转子角度。AD2S1210这类RDC芯片的工作方式不是直接ADC采样然后算反正切而是内部有一个Type-II跟踪环路让数字角度信号不断跟踪模拟输入误差信号被环路的积分特性吸收最后输出一个平滑的数字角度。这套机制的好处是分辨率可以做到16位甚至更高输出非常稳定没有增量计数的丢步风险也不容易被瞬间的毛刺干扰带偏。因为跟踪环路本身就是一个窄带滤波器对旋变信号里的谐波和噪声有抑制作用。不过RDC也有局限。它的响应受跟踪带宽限制通常设置成2kHz到8kHz位置环和速度环也可以用但带宽比磁编码器还是低。此外RDC输出的角度是单圈的没有多圈信息需要外部计数或者单独的多圈机构来记录圈数。2.3 分工之后接口和数据怎么打通在具体产品里我是这样设计的磁编码器的SPI或ABZ接口连到主控MCU的定时器和QEP实时读取速度环和换相信号旋变定子接到RDC芯片RDC用SPI接口把16位绝对角度送到同一个MCU作为位置环反馈。数据打通最关键的是同步采样。不能让位置环读到的是不同时刻的两个角度否则一相减就是人为误差。我会用一个PWM中心对齐信号作为硬件触发同时锁存磁编码器计数器的当前值和RDC的数据寄存器保证两个采样值的时间戳一致。这个细节看起来不起眼但对融合效果影响非常大。另外通信帧上要预留CRC或者校验和。机器人关节里电机线、电源线、信号线混在一起一旦出现干扰宁可丢掉一帧数据也不能误用坏数据。我的经验是磁编码器的SPI读操作至少用32位帧包含角度、状态位和CRCRDC读取时也一定要检查错误状态寄存器比如旋变信号丢失或跟踪失锁。3. 让两个传感器在同一个关节里安家硬件细节3.1 机械安装同轴度和气隙比想象中重要磁编码器的安装精度直接决定它能达到的精度天花板。磁钢要装在马达轴端传感器芯片固定在PCB上芯片中心和磁钢中心要尽量重合。以MT6701为例气隙最好控制在0.5到2毫米内太远信号太弱太近磁钢可能摩擦传感器。更关键的是偏心如果磁钢中心和旋转中心偏心0.1毫米角度误差就可能达到0.2度以上这对机器人关节来说不可接受。旋变的安装相对更麻烦因为它是桶状结构转子要套在电机轴上定子固定在壳体里。安装时要用专用工装保证定子和转子的同轴度通常要求控制在0.05毫米以内。否则旋变的输出信号会出现比较大的零位偏置和幅值不对称RDC解码出来的角度也会有明显的一次谐波误差。我在实际项目里吃过亏当时为了省事直接用螺钉压紧旋变转子而没有用定位工装结果在测角度误差曲线时一次谐波特别大怎么校准都压不掉。后来拆开重新定位装上后一次谐波分量直接小了一个数量级。机械安装这种事真的不能省。3.2 电源、隔离和采样同步磁编码器芯片一般只需要3.3V供电但要注意电源纹波。磁编码器输出的正余弦信号幅值只有毫伏级如果供电纹波耦合到信号里角度抖动就会增加。我建议用LDO给磁编码器单独供电不要直接和电机驱动的开关电源共路。RDC芯片就比较麻烦了它要驱动旋变的初级线圈需要一组功率激励信号常见的是7Vrms左右的正弦波。激励功放对电源质量要求高尤其是存在电机IGBT开关的时候激磁电压的幅值抖动会直接造成RDC角度误差。所以我通常会给激励级做单独的线性电源同时做好屏蔽。采样同步方面RDC芯片的数据更新频率和磁编码器的计数器锁存必须由同一个硬件事件触发。最简单的方式是用定时器的更新事件产生一个同步脉冲这个脉冲同时连接到RDC的采样引脚和MCU的锁存引脚。这样读取两个角度时能保证它们代表的是同一个机械角度时刻。3.3 EMC一起调试时最容易翻车的地方这套组合里最难受的干扰源是电机驱动器。PWM斩波电流在动力线缆上会产生强烈的di/dt通过空间耦合到旋变信号线或者磁编码器PCB上。如果发现角度数据在电机加速时出现抖动十有八九是EMC问题。我的经验是两条硬规矩旋变信号线和编码器信号线不能跟电机动力线走同一个连接器连接器内引脚之间也要留地线隔离。编码器PCB要尽量靠近电机轴安装并且用屏蔽罩盖住磁编码器芯片正好在屏蔽罩下方形成法拉第笼。另外RDC芯片的前级输入滤波器也值得调一调。AD2S1210的数据手册里有滤波电容推荐值但那是针对标准旋变实际要根据激励频率和线缆长度微调。太“紧”的滤波器会降低带宽太“松”又会把PWM噪声引入。我一般是先用示波器抓激励信号和次级信号的波形再根据噪声频谱调滤波器参数。4. 从数据到控制融合算法和双通道冗余4.1 为什么不能直接切换有些人想着“平时用磁编码器磁编坏了就切到旋变”这种思路看起来简单但实施下来问题很多。因为两者的动态特性不一样直接切换会在切换瞬间产生一个角度阶跃速度环会被激出明显振荡更严重的是可能触发过流保护。正确的思路是把两个传感器看作一个“双读数测量系统”。磁编码器告诉你现在转得有多快旋变RDC告诉你现在绝对角度在哪。两者可以互相对齐、互相校验再融合成一个单一的角度估计给控制器而不是轮流上岗。4.2 互补滤波让两条腿走路融合算法我用得最顺的是互补滤波结构简单实时性好不需要复杂的状态模型。基本思路是先把磁编码器的角度做差分得到角速度通过一个高通滤波器再让RDC的绝对角度通过一个低通滤波器。两者相加就得到一个既平滑又没有相位滞后的角度估计。也可以用速度融合的形式把磁编码器角速度作为前馈用RDC绝对位置的误差来做纯积分修正这样角度估计的动态响应更直接。实际工程里我会写成这样float angle_mag; // 磁编码器角度单位rad float speed_mag; // 磁编码器角速度由差分或M法/T法得到 float angle_rdc; // RDC绝对角度单位rad float angle_est; // 融合后的角度 float speed_est; // 融合后的角速度 // 每次同步采样中断里执行 float error wrap_pi(angle_rdc - angle_est); angle_est (speed_mag k * error) * dt; speed_est speed_mag k * error;补偿系数k决定了RDC在主通道上的修正速度。k太小低速时角度误差收敛慢k太大RDC的相位滞后又会侵入动态过程。我一般从10Hz左右的修正带宽调起然后看速度环扫频结果微调。4.3 冗余校验和失效切换逻辑除了融合还要做双通道一致性监测。每个控制周期都会比较磁编码器角度和RDC角度换算到同一个时间戳后求差。正常工作时这个差值应该在一个小范围内比如0.5度以内当某个传感器异常差值会突然增大。我会设置两级阈值第一级是“软告警”超过阈值时降低速度环增益防止系统失控第二级是“硬保护”超过更大阈值时直接触发安全停机。这里一定要让阈值随转速变化。比如静止时允许0.1度的差值高速运转时由于RDC跟踪滞后磁编码器角度和RDC角度的差值天然会变大不能一刀切。失效切换我采用“热切换”磁编码器故障时马上把互补滤波器里的磁编码器角速度替换为RDC角度的微分同时把速度环带宽降低保证机器人在安全模式下完成当前动作后停机。反过来RDC故障时磁编码器还能继续支撑位置环运行但要进入降级模式不允许继续执行全速轨迹。5. 踩坑实录我在这套组合上交过的学费5.1 磁钢偏心的周期性误差第一次在关节样机上跑这套组合时我注意到磁编码器读数和旋变RDC读数之间的差值会随着角度变化波形像正弦波一个旋转周期里出现一次大和小。当时我第一反应是“磁编码器精度不行”但后来仔细分析才知道问题出在磁钢安装偏心。为了验证我拿了颗高精度光编做基准让关节电机以匀速旋转同时记录磁编码器角度误差。误差曲线在0度和180度附近偏差最大典型的1次谐波。解决方法是先用FFT拟合误差曲线软件里把一次谐波成分补偿掉同时调整机械工装把中心偏心率压到0.05毫米以内。这里给个建议做磁编码器装配时一定要设计一个同心定位凸台让磁钢和电机轴同轴不是随便用厌氧胶粘上去就完事。否则后期软件补偿会很痛苦。5.2 温度漂移让零点偷偷跑掉另一件头疼的事是温漂。磁编码器的角度读数在常温下和RDC对标得很好可一旦关节连续跑半小时电机温度上到六七十度磁编码器的零点就开始慢慢偏移有时能到零点几度。RDC旋变这边倒是稳得很因为旋变本身是模拟变压器受温度影响小。于是我用RDC作为“温度基准”在软件里定期校正磁编码器的零偏。具体做法是每次机器人进入待机状态时等待关节静止然后计算磁编码器角度和RDC角度的偏差把这个偏差记录到非易失存储器里作为工作点的零偏。另外也可以在关节壳内放一个温度传感器做一维查表补偿。不过这种标定工作量比较大适合批量产线小批量项目用RDC动态校正更划算。5.3 低速抖动和驱动器干扰还有一个困扰很多人的现场问题关节在低速缓慢爬行时位置渲染会有明显的抖动感。如果只看磁编码器低速时角度变化量小量化噪声占比大速度反馈的毛刺就非常明显。这时RDC的优势就体现出来了它输出的角度平滑低速下几乎看不到量化跳动。把互补滤波器里的k系数调起来以后低速抖动明显改善。我这里实测过一组数据在1rpm转速下单磁编码器的速度反馈波动有正负0.5rpm融合RDC后降到正负0.05rpm。对力矩控制和碰撞检测来说这个提升非常重要。驱动器干扰的坑也在这个阶段暴露出来。刚开始电磁兼容没做好RDC在电机大电流换向时会突然跳变几度我把RDC的跟踪带宽调高了反而更严重因为干扰也进来了。最后靠给旋变激励信号加屏蔽、优化接地和调整输入滤波器才算压住。6. 验证与量产让组合方案从demo变成产品6.1 静态精度和动态响应的测试方法验证这套组合能不能用不能只看单传感器精度要看融合后的效果。我有一套固定的测试流程。静态精度测试用一个高精度光电编码器作为基准把关节锁定在不同的角度位置分别读取磁编码器角度和RDC角度记录误差曲线。注意把基准编码器安装尽量靠近传感器输入轴避免扭转刚度带来误差。动态响应测试给速度环一个正弦速度指令分别记录单磁编码器、单RDC、融合后三种方案的速度反馈波形。重点看速度环带宽是否够高频段有没有共振毛刺低速段速度反馈是否平滑。在实测里单磁编码器在60Hz以上容易出现毛刺单RDC到40Hz就有明显相位滞后融合后能平推到80Hz都不失稳。这个数据能直接说服老板也能量化评估是否达到设计目标。6.2 量产标定的完整流程量产和样机完全是两码事样机可以用手动校准量产必须自动化。我建议产线上至少保留三个标定工位装机检查工位检查磁钢气隙、旋变同轴度用角度误差快速检测装置判断装机质量不合格的件直接返工。零点对齐工位给关节上电把电机转到机械零位同时记录磁编码器角度、RDC角度把这两个角度写入关节存储器的标定区。这里一定要做二次校验防止第一次写入掉电失败。精度补偿工位用外接光编作为基准旋转整周采样自动生成磁编码器非线性误差补偿表同时生成RDC零偏和幅值不平衡修正参数。这个流程做完一台关节的传感器标定时间大概是2到3分钟比纯手工校准快得多而且一致性好。6.3 最后一点选型建议和成本控制从成本角度看磁编码器芯片加普通磁钢的成本很低旋变的成本稍高RDC芯片的价格在过去几年里降了不少已经接近中端光编。组合方案的总体成本大概比同精度的多圈光编便宜20%到30%而环境适应性和可靠性明显更好。选型建议上我倾向于这样分如果只是风力发电电机、泵类这种对绝对精度要求不高的场景单磁编码器就够。如果要做协作机器人的一体化关节追求安全、冗余和低成本磁编码器加RDC的组合性价比非常高。如果是大型重载工业机器人扭矩大、振动强、对绝对位置精度要求高那还是建议考虑高端光编或者双旋变RDC方案。根据我的个人经验这套组合最适合目前国产机器人“既要更低成本又要更高安全冗余”的窗口期。调试中如果遇到速度环相位裕量不足可以把磁编码器角速度环带宽调整到RDC修正带宽的三分之一左右再试一次很多莫名其妙的振动都会明显改善。这个技巧是排查了很多次才总结出来的希望对正在调关节反馈的朋友有帮助。
