伺服驱动器原理:FOC与三环架构

大家好,我是老张。在半导体设备这行摸爬滚打十几年,今天跟大伙儿聊聊伺服驱动器的核心——FOC(磁场定向控制)。

说实话,我刚入行那会儿,FOC还是个挺神秘的东西。那时候做设备调试,遇到电机抖动、响应慢,基本靠经验瞎蒙。后来搞明白了FOC的原理,才发现很多问题其实早有答案。

FOC基本原理:把交流电机当直流电机用

FOC的核心思想,说白了就是——把交流电机的控制,变得像直流电机一样简单。

你想想看,直流电机多好控制?给电压就转,调电压就变速。但交流电机不行,它的磁场和电流是耦合在一起的,牵一发而动全身。

FOC怎么做的呢?它通过坐标变换,把三相交流电流分解成两个独立的量:

  • d轴电流(Id):控制磁通,相当于直流电机的励磁电流
  • q轴电流(Iq):控制转矩,相当于直流电机的电枢电流

这样一来,交流电机的控制就变成了两个独立回路的控制。我在调试光刻机工件台时,就靠这个思路把定位精度从微米级提到了纳米级。

关键点:FOC的本质是解耦。把三相交流量,通过Clark变换和Park变换,变成两相直流量。然后就能像控制直流电机一样,分别控制磁通和转矩。

FOC磁场定向控制流程图 三相电流 Ia, Ib, Ic Clark变换 3相→2相静止 Park变换 静止→旋转 Id / Iq 直流量 PI控制器 电流环调节 反Park变换 旋转→静止 SVPWM 电机 反馈回路

三环架构:电流环、速度环、位置环

伺服驱动器的控制,通常分三层。从内到外分别是:电流环、速度环、位置环。我习惯叫它「三明治结构」。

电流环(最内层)

电流环是响应最快的环。它的任务就是让实际电流快速跟上给定电流。说白了,就是让电机「听话」——要多少电流就给多少。

我在调试刻蚀机的机械手时,遇到过电流环震荡的问题。电机嗡嗡响,手摸上去都发烫。后来发现是PI参数没调好,比例增益太大。嗯,这里要注意:电流环的带宽一般设到1-2kHz,再高就容易出问题。

调试技巧:调电流环时,先给一个阶跃信号,看电流的响应速度。上升时间控制在100-200μs比较理想。超调量不要超过5%。

速度环(中间层)

速度环在电流环外面。它根据目标速度和实际速度的差值,计算出需要的电流值,然后交给电流环去执行。

速度环的带宽一般比电流环低一个数量级,大概100-200Hz。为什么?因为速度环的反馈来自编码器,编码器的采样频率有限,太快了反而会引入噪声。

控制环 典型带宽 主要任务 反馈来源
电流环 1-2 kHz 电流跟踪 电流传感器
速度环 100-200 Hz 速度控制 编码器
位置环 10-50 Hz 定位控制 编码器/光栅尺

位置环(最外层)

位置环是最外层的控制环。它负责让电机精确地停在目标位置。在半导体设备里,这个环的要求最高——动不动就是微米级甚至纳米级的定位精度。

我记得调试一台晶圆搬运设备时,位置环总是有稳态误差。查了半天,发现是位置环的积分项没加。加上之后,误差从50μm降到了2μm。所以说,有时候问题不在硬件,就在软件参数上。

避坑指南:我曾经遇到过位置环和速度环互相打架的情况。位置环输出饱和了,速度环还在拼命追。结果电机来回震荡,就是停不下来。解决办法是加一个抗饱和(Anti-Windup)机制。

PWM调制与死区时间

FOC算出来的电压指令,最终要通过PWM(脉宽调制)变成实际的电压信号,驱动电机转动。

PWM的原理不复杂——通过改变占空比来调节平均电压。但实际应用中,有个很头疼的问题:死区时间。

什么是死区时间?简单说,就是上下桥臂不能同时导通。如果同时导通,电源就短路了,那后果...你懂的。

所以,在切换上下桥臂时,要插入一段「死区时间」——让两个管子都关断一会儿。这个时间通常设1-3μs。

但死区时间会带来副作用:电压失真、电流谐波、转矩脉动。尤其是在低速运行时,影响特别明显。

经验之谈:我调试过一台涂胶机,低速时电机抖动得厉害。查了三天,最后发现是死区时间补偿没做好。加上补偿算法后,抖动立刻消失了。所以,死区时间不是设了就完事,一定要做补偿。

死区补偿的方法主要有两种:

  • 电压补偿法:根据电流方向,在电压指令上叠加一个补偿量
  • 时间补偿法:直接调整PWM的占空比,抵消死区的影响

我个人更推荐电压补偿法,实现起来简单,效果也够用。当然,如果你对精度要求特别高,可以考虑时间补偿法,但算法会复杂一些。

好了,关于FOC和三环架构,今天就聊到这儿。这些内容看着理论性强,但实际调试中,每一步都会遇到具体问题。多动手、多记录,慢慢就有感觉了。


专注资料整理