机器人伺服驱动——三环PID参数整定与振动抑制技术
2026/08/05 17:37:21
一、伺服三环控制架构伺服驱动器采用电流环→速度环→位置环三环级联控制架构,各环带宽呈严格递进关系以确保稳定性:电流环(最内环)带宽最高,典型值1~2kHz,采用PI控制器在同步旋转坐标系(d-q轴)下调节转矩电流,响应速度决定整个系统的力矩动态;速度环(中间环)带宽约200~400Hz,将电流环等效为一阶惯性环节后进行PI调节,其带宽受限于机械谐振频率的1/3~1/5;位置环(最外环)带宽50~100Hz,通常采用纯P控制(避免积分饱和导致超调),带宽由速度环闭环特性与机械刚度共同决定。三环设计遵循"内环快于外环5~10倍"的铁律,任何一环调优不当都将向上传递放大误差。
二、电流环PI调谐与dq轴解耦永磁同步电机在d-q坐标系下的电压方程为:ud=R·id+Ld·did/dt-ωLq·iq,uq=R·iq+Lq·diq/dt+ω(Ld·id+ψf)。采用零极点对消法设计电流环PI参数:令积分时间常数Ti=L/R抵消电机电气时间常数极点,比例增益Kp=L·ωc(ωc为目标带宽),可使电流环降阶为一阶系统。同时引入前馈解耦项ωLq·iq和-ω(Ld·id+ψf)抵消旋转反电动势耦合,将MIMO系统解耦为两个独立的SISO控制回路,实测电流阶跃响应时间<0.5ms,稳态误差<1%。
三、速度环带宽与机械谐振抑制速度环设计面临机械谐振的严峻挑战:电机转子与负载通过联轴器、丝杠等传动链连接,存在多个扭转谐振模态(典型频率200~2000Hz)。当速度环增益过高时,谐振峰进入控制带宽导致啸叫乃至发散振荡。抑制方案:(1)陷波滤波器——在速度环输出端级联2~4个二阶陷波器,中心频率对准谐振峰(通过FFT在线辨识),深度-30~-60dB,带宽系数0.1~0.3,实测可将谐振峰值压制20dB以上;(2)观测器补偿——构建龙伯格状态观测器估算负载侧转矩扰动,前馈补偿至电流指令,等效于增大系统对负载惯量的鲁棒性而不提升实际增益,从根本上避免激励谐振模态。
四、位置环前馈控制纯反馈位置环受限于带宽,高速定位时存在显著的跟随误差(轮廓误差)。引入前馈复合控制可将跟踪精度大幅提升:速度前馈Kvff将期望轨迹的微分(目标速度)直接叠加到速度环给定,理论上100%速度前馈可使匀速段跟随误差归零;加速度前馈Kaff将目标加速度乘以等效惯量前馈至转矩指令,补偿加减速段的惯性滞后;摩擦力补偿采用Stribeck模型Ff=Fc+(Fs-Fc)·e-(v/vs)²+B·v,在速度过零时精确补偿静摩擦-库仑摩擦过渡,消除换向时的"平台效应"。三项前馈联合使位置误差从±8counts压缩至±1counts。
五、惯量辨识与自适应增益调度负载惯量变化(如机器人末端抓取不同工件)直接改变速度环被控对象增益,固定PID参数无法保证全工况性能。在线惯量辨识采用最小二乘递推算法(RLS):在速度环注入小幅正弦扫频信号(幅值5%额定转速、频率50~500Hz),采集电磁转矩和角加速度,构造回归方程Te=J·dω/dt+TL,带遗忘因子λ=0.98递推估计转动惯量J。辨识收敛后(精度<5%),按增益调度表自动调整速度环增益Kvp=J/J0·Kvp0(J0为标称惯量),确保惯量比0.5~10范围内速度环带宽波动<15%。
六、伺服刚度与跟随误差模型伺服刚度Kservo定义为外部扰动力矩ΔTL与产生的位置偏差Δθ之比:Kservo=ΔTL/Δθ=Kp·Kv·Kt,即位置环增益×速度环增益×转矩常数的乘积。高伺服刚度意味着更强的抗扰能力,但受限于机械谐振频率和传感器量化噪声。跟随误差与运动指令的关系可近似为:e(t)≈v(t)/Kv+a(t)·J/KtKv+Ff/KtKv,揭示了速度、加速度和摩擦三项误差源的定量贡献,为前馈补偿设计提供了明确的物理依据。
七、Bode图调优案例以某SCARA机器人J3关节为对象:调优前,速度环开环Bode图显示在680Hz处存在+12dB谐振峰,相位裕度仅28°,位置误差±8counts且伴有高频抖动。调优过程:首先用HP35670A动态信号分析仪扫频确认谐振频率682Hz,在速度环输出插入二阶陷波器(fn=682Hz/ζ=0.15/depth=-40dB)将谐振峰压至-28dB;随后将速度环增益从80Hz提升至180Hz,相位裕度恢复到52°;加入85%速度前馈+70%加速度前馈后,圆弧插补轨迹的轮廓误差从±0.12mm降至±0.015mm,位置跟随误差稳定在±1counts以内,整机运行振动≤0.3mm/s(ISO 10816标准优良等级),验证了系统化调优方法的有效性。
二、电流环PI调谐与dq轴解耦永磁同步电机在d-q坐标系下的电压方程为:ud=R·id+Ld·did/dt-ωLq·iq,uq=R·iq+Lq·diq/dt+ω(Ld·id+ψf)。采用零极点对消法设计电流环PI参数:令积分时间常数Ti=L/R抵消电机电气时间常数极点,比例增益Kp=L·ωc(ωc为目标带宽),可使电流环降阶为一阶系统。同时引入前馈解耦项ωLq·iq和-ω(Ld·id+ψf)抵消旋转反电动势耦合,将MIMO系统解耦为两个独立的SISO控制回路,实测电流阶跃响应时间<0.5ms,稳态误差<1%。
三、速度环带宽与机械谐振抑制速度环设计面临机械谐振的严峻挑战:电机转子与负载通过联轴器、丝杠等传动链连接,存在多个扭转谐振模态(典型频率200~2000Hz)。当速度环增益过高时,谐振峰进入控制带宽导致啸叫乃至发散振荡。抑制方案:(1)陷波滤波器——在速度环输出端级联2~4个二阶陷波器,中心频率对准谐振峰(通过FFT在线辨识),深度-30~-60dB,带宽系数0.1~0.3,实测可将谐振峰值压制20dB以上;(2)观测器补偿——构建龙伯格状态观测器估算负载侧转矩扰动,前馈补偿至电流指令,等效于增大系统对负载惯量的鲁棒性而不提升实际增益,从根本上避免激励谐振模态。
四、位置环前馈控制纯反馈位置环受限于带宽,高速定位时存在显著的跟随误差(轮廓误差)。引入前馈复合控制可将跟踪精度大幅提升:速度前馈Kvff将期望轨迹的微分(目标速度)直接叠加到速度环给定,理论上100%速度前馈可使匀速段跟随误差归零;加速度前馈Kaff将目标加速度乘以等效惯量前馈至转矩指令,补偿加减速段的惯性滞后;摩擦力补偿采用Stribeck模型Ff=Fc+(Fs-Fc)·e-(v/vs)²+B·v,在速度过零时精确补偿静摩擦-库仑摩擦过渡,消除换向时的"平台效应"。三项前馈联合使位置误差从±8counts压缩至±1counts。
五、惯量辨识与自适应增益调度负载惯量变化(如机器人末端抓取不同工件)直接改变速度环被控对象增益,固定PID参数无法保证全工况性能。在线惯量辨识采用最小二乘递推算法(RLS):在速度环注入小幅正弦扫频信号(幅值5%额定转速、频率50~500Hz),采集电磁转矩和角加速度,构造回归方程Te=J·dω/dt+TL,带遗忘因子λ=0.98递推估计转动惯量J。辨识收敛后(精度<5%),按增益调度表自动调整速度环增益Kvp=J/J0·Kvp0(J0为标称惯量),确保惯量比0.5~10范围内速度环带宽波动<15%。
六、伺服刚度与跟随误差模型伺服刚度Kservo定义为外部扰动力矩ΔTL与产生的位置偏差Δθ之比:Kservo=ΔTL/Δθ=Kp·Kv·Kt,即位置环增益×速度环增益×转矩常数的乘积。高伺服刚度意味着更强的抗扰能力,但受限于机械谐振频率和传感器量化噪声。跟随误差与运动指令的关系可近似为:e(t)≈v(t)/Kv+a(t)·J/KtKv+Ff/KtKv,揭示了速度、加速度和摩擦三项误差源的定量贡献,为前馈补偿设计提供了明确的物理依据。
七、Bode图调优案例以某SCARA机器人J3关节为对象:调优前,速度环开环Bode图显示在680Hz处存在+12dB谐振峰,相位裕度仅28°,位置误差±8counts且伴有高频抖动。调优过程:首先用HP35670A动态信号分析仪扫频确认谐振频率682Hz,在速度环输出插入二阶陷波器(fn=682Hz/ζ=0.15/depth=-40dB)将谐振峰压至-28dB;随后将速度环增益从80Hz提升至180Hz,相位裕度恢复到52°;加入85%速度前馈+70%加速度前馈后,圆弧插补轨迹的轮廓误差从±0.12mm降至±0.015mm,位置跟随误差稳定在±1counts以内,整机运行振动≤0.3mm/s(ISO 10816标准优良等级),验证了系统化调优方法的有效性。
——全文约1100字