人形机器人关节模组双编码器
一句话核心
输入端(电机侧编码器):贴转子,直接看电机转子真实角度,是FOC换相、电流环、速度环的原生反馈;输出端(负载侧编码器)在减速器之后,测的是关节法兰真实位置,只能做外环位置环,不能拿来跑电流/速度内环,否则共振、抖振、不稳定
典型串级闭环顺序: 电流环(最内环,带宽最高) → 速度环 → 位置环(最外环,带宽最低)
一、两个编码器各自作用
输入端编码器(电机侧,高速端)
- FOC换相必需:电流环必须知道电机转子电角度,这个角度只能电机侧编码器直接给;输出端角度除以减速比,不能直接用来换相(中间有弹性扭变,电角度会失真,直接换相会力矩波动、发热、失步)
- 速度环反馈:电机转速高,编码器微分得到的速度信噪比好、延迟小、带宽高,适合做高速内环,快速稳定电机本身的转动
- 间接作用:和输出端做差值,用来估算减速器扭转角、做力矩观测、传动误差诊断、安全比对
输出端编码器(负载侧,低速端)
- 直接测量减速器法兰、连杆的真实物理位置,把谐波/行星减速器的弹性扭转变形、背隙、传动误差全部包含进去
- 只负责外环位置闭环:修正“电机转到位了,但是关节被弹性扭歪了”这个误差,保证机器人连杆定位准
- 附加:断电保持绝对位置、碰撞/柔顺观测、双编码器安全校验
二、为什么输入端可以跑电流环、速度环
- 物理上和转子刚性绑定:编码器和转子几乎无弹性,测量的就是电机本体的状态,反馈和被控对象(电机电磁转矩)之间没有柔性环节
- 转速高,微分测速质量好:减速比比如100:1,电机转100圈,输出才1圈;电机侧编码器同样采样频率下,角度增量大、量化噪声小,微分出来的速度干净,速度环带宽可以拉很高
- 电流环是电磁环,带宽远高于机械谐振频率:电流环控制绕组磁场,只和转子电角度强相关,不关心后面减速器怎么扭;它是最快的一环,微秒/几十us级别,只能用紧贴转子的编码器
电流环本质是电磁控制,不是关节机械控制;它只管电机内部磁场,不管负载连杆
三、为什么输出端编码器不能拿来跑电流环、速度内环,只能做位置外环(重点)
核心根源:电机 ↔ 减速器柔性 ↔ 负载,是一个二阶谐振系统(弹簧-质量块),谐振频率一般只有几十Hz
- 输出端信号和电机转子之间隔着减速器弹性体(谐波柔轮),电机转矩先压缩这个“弹簧”,再带动负载;负载端角度是弹簧末端的位置,不是电机转子的直接状态
- 如果你拿负载侧角度微分做速度环、甚至拿来做FOC换相:控制器看到负载动了,立刻去改电机电流;电机一动,弹簧又扭,信号来回反相激励,直接激发关节共振,抖动、啸叫、甚至失控
- 低速、角度增量极小,微分测速噪声爆炸 输出端转得极慢,编码器每一拍角度变化很小,微分得到的速度信号信噪比很差,必须做大滤波;滤波带来巨大相位滞后,内环相位裕度直接垮掉,根本稳不住
- 带宽分层原则(人形/协作关节标准)
- 电流环:kHz级(最高),电机侧反馈,电磁层
- 速度环:几百Hz,电机侧反馈,稳定转子
- 位置外环:十几~几十Hz,负载侧反馈,缓慢修正弹性带来的位置偏差
外环带宽必须显著低于内环,更要低于关节机械谐振点;输出编码器天然适合做慢的位置校正,不适合快的内环
四、控制框图(标准双环关节)
目标关节位置 ↓ 【位置环(输出编码器反馈)】输出目标速度 ↓ 【速度环(电机编码器反馈)】输出目标转矩/电流 ↓ 【电流环(电机编码器电角度)】FOC,输出PWM驱动电机 ↓ 电机 → 减速器(柔性) → 输出法兰 + 输出编码器
补充误区澄清
不是输出编码器绝对不能用它算速度,而是不能把它当内环速度反馈; 工程上可以用输出编码器的速度做扰动观测、前馈补偿、刚度估计,但不能闭环给速度环、电流环。 也有一些高阶算法(状态观测器)融合两端信号,但依然保留:FOC换相、电流内环、速度内环的主反馈源是电机端编码器










评论0