第四节 振镜控制核心概念:位置环、速度环、电流环、PID调节、前馈控制与增益参数

振镜电机(Galvo Motor)本质上是一种有限转角力矩电机,其控制目标是在极短的时间内将负载镜片精确、稳定地定位到目标角度。与普通旋转电机不同,振镜系统对带宽、响应速度和重复定位精度有着近乎苛刻的要求。要理解振镜控制,必须从控制环路的层级结构入手:电流环(最内层)、速度环(中间层)、位置环(最外层),以及贯穿其中的PID调节、前馈控制与增益参数整定。本节将系统拆解这些核心概念,并给出工程实战中的判断方法与调参路径。

振镜三环控制架构与信号流 位置环(外环) 目标角度 θ_ref 反馈角度 θ_fb 比例+前馈 输出:速度指令 采样率:20~100 kHz 带宽:1~5 kHz 速度环(中间层) 速度指令 ω_ref 反馈速度 ω_fb PI 调节 输出:电流指令 采样率:20~100 kHz 带宽:5~15 kHz 电流环(内层) 电流指令 i_ref 反馈电流 i_fb PI 调节 输出:PWM 占空比 采样率:50~200 kHz 带宽:10~30 kHz 反馈信号:编码器/光电传感器 → 角度/速度/电流 前馈控制:速度前馈 + 加速度前馈 + 摩擦前馈 关键参数与工程要点 • 位置环增益(Kp_pos):决定定位刚度与跟踪带宽,过大引起振荡 • 速度环比例(Kp_vel):抑制速度波动,影响动态响应 • 速度环积分(Ki_vel):消除稳态速度误差,但过大导致低频谐振 • 电流环PI:保证力矩快速跟随,带宽通常设为速度环的5~10倍 • 前馈系数:速度前馈≈1,加速度前馈≈J/Kt,需实测惯量 • 增益裕度:相位裕度≥45°,增益裕度≥10 dB,避免机械谐振点

上图展示了振镜控制的三环嵌套结构。外环位置环根据目标角度与反馈角度的偏差计算速度指令;中间层速度环对速度偏差进行PI调节,输出电流指令;内层电流环则控制电机绕组电流,使其快速跟踪指令值。前馈路径从位置环直接叠加到速度环和电流环,用于补偿系统惯量、摩擦和反电动势带来的滞后。理解这一信号流是进行参数整定的基础。

4.1 三环控制的核心原理与作用边界

振镜控制系统的三环结构并非随意设计,而是基于物理系统的固有特性:电机电气时间常数远小于机械时间常数,因此电流环可以比速度环更快;速度环又比位置环更快。这种时间尺度分离使得每个环路可以独立整定,降低耦合复杂度。

  • 电流环(最内层):控制电机绕组电流,直接决定输出力矩。由于力矩与电流成正比(T=Kt·i),电流环的带宽决定了系统能多快产生所需力矩。电流环通常采用PI控制器,其比例项提高力矩响应速度,积分项消除稳态电流误差。电流环的反馈来自采样电阻或霍尔传感器,采样率需达到50kHz以上。
  • 速度环(中间层):控制电机转速,抑制负载扰动和力矩波动。速度反馈可由编码器差分或测速发电机获得。速度环的PI参数直接影响系统的阻尼特性——比例项提供阻尼,积分项消除稳态速度误差。速度环带宽通常为电流环的1/5~1/10,以保证稳定性。
  • 位置环(最外层):控制最终定位角度,是用户最直接感知的环路。位置环通常只使用比例控制(P),因为积分作用会引入相位滞后,降低系统稳定性。位置环的输出是速度指令,因此位置环增益Kp_pos的单位是1/s(即速度/角度差)。

工程经验:三环带宽的典型比例关系为:电流环带宽 ≈ 10×速度环带宽 ≈ 100×位置环带宽。例如,若位置环带宽要求2kHz,则速度环需20kHz,电流环需200kHz。实际振镜系统中,受限于采样率和功率放大器,电流环带宽通常在10~30kHz,速度环5~15kHz,位置环1~5kHz。

4.2 PID调节与振镜系统的特殊适配

标准PID控制器在振镜系统中需要针对应用场景进行适配。振镜的负载是镜片,转动惯量小,但要求极高的加速度(可达100,000 rad/s²),因此对控制器的动态性能要求远超普通伺服系统。

控制项 标准作用 振镜系统适配 典型参数范围
比例(P) 响应偏差,提供刚度 位置环只用P,速度环P提供阻尼 Kp_pos: 50~500 1/s
Kp_vel: 0.1~2 A·s/rad
积分(I) 消除稳态误差 速度环和电流环使用,位置环慎用 Ki_vel: 100~2000 A/rad
Ki_cur: 500~5000 V/A·s
微分(D) 预测趋势,增加阻尼 较少使用,因噪声放大严重;可用速度环替代 一般不启用,或极小的Kd

振镜系统中,微分项(D)通常被速度环的比例项替代。这是因为位置信号的微分会放大编码器量化噪声,导致电流指令抖动。速度环本身就是一个“带滤波的微分器”,能更平滑地提供阻尼。

4.3 前馈控制:提升跟踪性能的关键

反馈控制本质上是“事后纠偏”,而前馈控制是“事前补偿”。在振镜扫描应用中,目标轨迹往往是重复的(如正弦扫描、三角形扫描),前馈可以显著减小跟踪滞后。

  1. 速度前馈:将目标速度乘以系数Kff_v叠加到速度指令上。理想情况下Kff_v=1,但实际因系统阻尼和摩擦,通常取0.8~1.2。速度前馈能消除匀速段的跟踪滞后。
  2. 加速度前馈:将目标加速度乘以系数Kff_a叠加到电流指令上。Kff_a的理论值为转动惯量J除以力矩常数Kt(即J/Kt)。由于振镜的转动惯量较小(通常0.1~10 g·cm²),Kff_a数值很小,但作用显著,能大幅减小加减速段的动态误差。
  3. 摩擦前馈:针对静摩擦和库仑摩擦进行补偿。振镜电机通常采用无刷无铁芯设计,摩擦较小,但在低速或换向时仍需补偿。摩擦前馈通常是一个与速度方向相关的常数。

调参技巧:前馈系数不应单独整定。正确顺序是:先整定电流环→再整定速度环→然后整定位置环→最后加入前馈。前馈系数从小往大调,观察跟踪误差的减小情况。若误差从“滞后”变为“超前”,说明前馈过大。

4.4 增益参数整定流程与实战案例

增益参数整定是振镜调试中最耗时、最考验经验的环节。以下是一个完整的整定流程,以某型号振镜(转动惯量J=2.5 g·cm²,力矩常数Kt=0.8 N·m/A,电枢电阻R=2.5Ω,电感L=0.4mH)为例。

案例背景:某激光打标机使用振镜扫描,要求定位时间<0.5ms(从满幅的10%到90%),重复精度±15μrad,跟踪误差<50μrad(正弦扫描500Hz)。初始调试时,系统出现明显振荡,定位时间超过2ms。

第一步:电流环整定

电流环的电气时间常数τ_e = L/R = 0.4mH / 2.5Ω = 0.16ms。电流环PI参数初始值:Kp_cur = L×带宽 / (Kt×Vdc) ≈ 0.0004×20000 / (0.8×24) ≈ 0.42,Ki_cur = R×带宽 / Vdc ≈ 2.5×20000/24 ≈ 2083。实际调试中,先只加比例项,增大Kp_cur直到电流波形出现轻微振荡,然后回退20%,再加入积分项消除稳态误差。

第二步:速度环整定

速度环的机械时间常数τ_m = J×R / Kt² = 2.5e-7×2.5 / 0.64 ≈ 0.98ms。速度环带宽目标设为5kHz。Kp_vel = J×带宽 / Kt = 2.5e-7×5000 / 0.8 ≈ 1.56,Ki_vel = Kp_vel / τ_m ≈ 1590。实际调试中,先设Ki_vel=0,增大Kp_vel直到速度响应出现振荡,然后回退30%,再逐步增加Ki_vel。

第三步:位置环整定

位置环带宽目标2kHz。Kp_pos = 带宽 = 2000 1/s。但实际受速度环带宽限制,Kp_pos通常只能达到速度环带宽的1/5~1/10。先设Kp_pos=500,观察阶跃响应,逐步增大直到出现超调或振荡。

第四步:前馈补偿

速度前馈Kff_v从0.5开始,逐步增加到1.0,观察正弦跟踪误差。加速度前馈Kff_a的理论值为J/Kt = 2.5e-7/0.8 = 3.125e-7,实际从0.5倍理论值开始,逐步增加。

参数 初始值 整定后 效果
Kp_cur 0.42 0.35 电流响应无振荡
Ki_cur 2083 1800 稳态电流误差<1%
Kp_vel 1.56 1.2 速度超调<5%
Ki_vel 1590 1200 速度稳态误差消除
Kp_pos 500 800 定位时间0.45ms
Kff_v 0.5 0.95 跟踪误差从200μrad降至60μrad
Kff_a 1.5e-7 2.8e-7 跟踪误差降至35μrad

结果对比:整定后,定位时间从2ms缩短至0.45ms,重复精度达到±12μrad,500Hz正弦跟踪误差从200μrad降至35μrad。但代价是系统对机械谐振更敏感,在8kHz附近出现轻微振荡,最终通过增加陷波滤波器解决。

风险提示:盲目增大增益会导致振镜电机过热、驱动器过流或机械谐振。每次调整增益后,应检查电机温度(不超过85℃)、驱动器电流(不超过额定值)和噪声水平。若出现高频啸叫,立即回退增益。

4.5 常见误区与总结复盘

在振镜控制调试中,工程师常陷入以下误区,导致调试周期延长或系统性能不达标。

  • 误区一:位置环增益越大越好。实际上,位置环增益受限于速度环带宽和机械谐振频率。过大的Kp_pos会导致系统振荡,甚至损坏机械结构。
  • 误区二:忽略电流环的饱和。当电流指令超过驱动器最大输出时,电流环进入饱和状态,此时系统表现为非线性,所有线性整定方法失效。应确保电流裕量至少20%。
  • 误区三:前馈系数直接取理论值。理论值基于理想模型,实际系统存在摩擦、柔性、温度漂移等因素,必须通过实验微调。
  • 误区四:只关注阶跃响应,忽略跟踪性能。振镜在扫描应用中更多是连续轨迹跟踪,应同时评估正弦跟踪误差和阶跃响应。

复盘总结:振镜控制的核心是“分层整定、由内而外、前馈补偿、谐振规避”。三环结构提供了清晰的调试路径,PID参数是基础,前馈是性能提升的关键,而增益参数必须在实际负载条件下验证。建议每次调试记录参数和对应的性能指标,形成经验数据库,便于后续项目快速复用。