手把手教你电机FOC控制【一】

范子琦

已于 2022-09-18 16:40:30 修改

阅读量1w

点赞数 6

分类专栏： FOC 文章标签：单片机 FOC 电机卡尔曼

于 2022-09-18 16:37:02 首次发布

本文链接：https://blog.csdn.net/oXiaoLingTong/article/details/123867530

版权

FOC 专栏收录该内容

4 篇文章 26 订阅

订阅专栏

手把手教你电机FOC控制【一】

文章作者: 范子琦
文章链接: https://www.robotsfan.com/posts/d99d1c1a.html
版权声明: 本博客所有文章除特别声明外，均采用 CC BY-NC-SA 4.0 许可协议。转载请注明来自范子琦的博客！

FOC框架引入

三向电机，分别为UVW三向，角度互差120度。若使用BLDC控制方法，如下图每次换向增加60度，转子只能到达六个位置，所以六步换向时会有振动。使用FOC控制方法可以使转子到达任意角度，所以运行起来会更加平滑。

如果想到达40度的位置，只需要在0度方向通电一段时间，在60度方向通电一段时间，再在空矢量的状态下通电一段时间（全桥000或111的位置为空矢量，空矢量的时长用来调节扭矩。后面会讲到），三段时间组成一个周期，以这个周期循环产生PWM，即可锁定至40度。若想到达其他角度，只需改变0度和60度的通电时长比例。

要想使磁场旋转起来，就需要输入正弦电压，但我们输入的是直流电，我们马上想到可以使用PWM波。通过不断改变PWM脉宽就可以模拟正弦电压，体现在电流上则为正弦电流。

下图为一个完整的FOC流程图：

我们先来看正向通路：输入 $I_{d\_ref}$ 和 $I_{q\_ref}$ 与下文反馈通路采样得到的电流 $I_d$ 和 $I_q$ 进行PID控制输出 $U_d$ 和 $U_q$ （输入的 $I_{d\_ref}$ 通常为0， $I_{q\_ref}$ 前通常还需要接入一个速度PID构成速度环），再通过反Park变换转换成 $U_\alpha$ 和 $U_\beta$ ，通过SVPWM模块控制定时器产生六路互补的PWM信号，最后使用PWM信号控制全桥MOS管的通断，产生三向电压使电机转动。

再来看反馈通路：通过采样电阻采集任意两相电流，根据基尔霍夫电流定律可以算出第三相电流，将三向电流通过Clark变换转化成 $I_\alpha$ 和 $I_\beta$ ，再通过Park变换转换成 $I_d$ 和 $I_q$ ，作为反馈传入PID控制器构成电流环。

上图中的Park变换和反Park变换需要当前的角度作为输入；速度PID需要速度作为反馈。所以需要获得电机的速度与角度。角度和速度的获取方法分为有感和无感。有感方式使用霍尔元件（Hall Sensor），安装在电机上就可以检测电机磁铁的位置。无感使用观测器（observer）获得角度速度信息，本文将使用扩展卡尔曼滤波观测器（EKF），输入为 $U_\alpha$ 、 $U_\beta$ 、 $I_\alpha$ 、 $I_\beta$ 。使用无感方式不需要霍尔传感器，可以减少连接线的数量，也可以减小成本。

坐标变换

为什么要使用坐标变换？电机控制大多是在控制速度/转矩，需要用PID闭环控制正弦交流电压的幅值和角度，不是很容易实现，所以通过坐标变化把正弦交流信息分解成角度信息（Q轴控制转矩）和幅值信息（D轴控制磁场）单独控制。

FOC的变换中要满足等幅值变换，即变换前后幅值不变。

坐标变换都分为正向变换和反向变换，正向变换都是对电流进行操作的，反向变换都是对电压进行操作的。

下面的变换均采用联立和矩阵两种形式表示，以方便使用。

Clark变换

Clark变换实现了三向坐标系 $(a, b, c)$ 与直角坐标系 $(\alpha,\beta)$ 间的转换。

正向Clark变换

Clark反变换则将两相信号转换为三相信号。已知三相坐标系 $I_a,I_b,I_c)$ ，这三个基向量不是正交的，所以可以将其正交化为一个直角坐标系，命名为 $\alpha-\beta$ 坐标系，变换公式为：
$\left\{\begin{array}{l} \begin{aligned} I_\alpha&=I_a-I_b\text{cos}60-I_c\text{cos}60 \\ &=I_a-\frac{1}{2}I_b-\frac{1}{2}I_c \end{aligned} \\ \begin{aligned} I_\beta&=I_b\text{cos}30-I_c\text{cos}30 \\ &=\frac{\sqrt3}{2}I_b-\frac{\sqrt3}{2}I_c \end{aligned} \end{array}\right.$

表示为矩阵形式：
$\left[\begin{array}{c} I_{\alpha} \\ I_{\beta} \end{array}\right]= \left[\begin{array}{ccc} 1 & -\frac{1}{2} & -\frac{1}{2} \\ 0 & \frac{\sqrt{3}}{2} & -\frac{\sqrt{3}}{2} \end{array}\right] \left[\begin{array}{c} I_{a} \\ I_{b} \\ I_{c} \end{array}\right]$
我们一般在电路中只采集两相电流，第三相电流可以使用基尔霍夫电流定律得出（ $I_a+I_b+I_c=0$ ），故上式也可整理为以下形式：
$\left\{\begin{array}{l} I_\alpha=\frac{3}{2}I_a \\ I_\beta=\frac{\sqrt3}{2}I_a+\sqrt3I_b \end{array}\right.$

矩阵形式：
$\left[\begin{array}{c} I_{\alpha} \\ I_{\beta} \end{array}\right]= \left[\begin{array}{cc} \frac{3}{2} & 0\\ \frac{\sqrt{3}}{2} & \sqrt{3} \end{array}\right] \left[\begin{array}{c} I_{a} \\ I_{b} \end{array}\right]$
由于变换前后 $I_a$ 和 $I_\alpha$ 幅值要相同，所以要进行等幅值变换，变换系数为 $\frac{2}{3}$ ，即变为
$\left\{\begin{array}{l} I_\alpha=I_a \\ I_\beta=\frac{1}{\sqrt3}(I_a+2I_b) \end{array}\right.$
矩阵形式：
$\left[\begin{array}{c} I_{\alpha} \\ I_{\beta} \end{array}\right]= \left[\begin{array}{cc} 1 & 0\\ \frac{1}{\sqrt{3}} & \frac{2}{\sqrt{3}} \end{array}\right] \left[\begin{array}{c} I_{a} \\ I_{b} \end{array}\right]$
（这里的系数在后文SVPWM里相电压的幅值与电压空间矢量之间有一个 $\frac{3}{2}$ 的系数相抵消）

MATLAB实现为：

反向Clark变换

反Clark变换则将三相信号转换为两相信号。根据图可以写出：
$\left\{\begin{array}{l} U_{a} = U_{\alpha} \\ U_{b} = -\frac{1}{2}U_{\alpha} + \frac{\sqrt3}{2}U_{\beta}\\ U_{c} = -\frac{1}{2}U_{\alpha} - \frac{\sqrt3}{2}U_{\beta} \end{array}\right.$
矩阵形式：
$\left[\begin{array}{c} U_{a} \\ U_{b} \\ U_{c} \end{array}\right]= \left[\begin{array}{ccc} 1 & 0 \\ -\frac{1}{2} & \frac{\sqrt{3}}{2} \\ -\frac{1}{2} & -\frac{\sqrt{3}}{2} \end{array}\right] \left[\begin{array}{c} U_{\alpha} \\ U_{\beta} \end{array}\right]$

MATLAB实现为：

Park变换

Park变换实现了两相坐标系 $(\alpha,\beta)$ 与转子坐标系 $(d, q)$ 间的转换，此变换可以将正弦变量线性化。其中 $d$ 指向转子中心， $q$ 指向切线方向， $\theta$ 是转子当前的角度，也就是说 $d - q$ 坐标系始终跟着转子同步旋转。

正向Park变换

则根据上图可以写出
$\left\{\begin{array}{l} I_{d}=I_{\alpha} \cos\theta+I_{\beta} \sin\theta \\ I_{q}=-I_{\alpha} \sin\theta+I_{\beta} \cos\theta \end{array}\right.$
很明显上述变换可以用旋转矩阵来表示，使用矩阵形式可以很方便地写出：
$\left[\begin{array}{l} I_{d} \\ I_{q} \end{array}\right]= \left[\begin{array}{cc} \cos \theta & \sin \theta \\ -\sin \theta & \cos \theta \end{array}\right] \left[\begin{array}{l} I_{\alpha} \\ I_{\beta} \end{array}\right]$
（如果 $d$ 轴为0，则功率全部输出在 $q$ 轴上。）

MATLAB实现为

反Park变换

根据上面的推导可以求得反Park变换
$\left\{\begin{array}{l} U_{\alpha}=U_{d} \cos\theta-U_{q} \sin\theta \\ U_{\beta}= U_{d} \sin\theta+U_{q} \cos\theta \end{array}\right.$
同理，使用旋转矩阵可以求出反变换的系数矩阵：
$\left[\begin{array}{l} U_{\alpha} \\ U_{\beta} \end{array}\right]= \left[\begin{array}{cc} \cos \theta & -\sin \theta \\ \sin \theta & \cos \theta \end{array}\right] \left[\begin{array}{l} U_{d} \\ U_{q} \end{array}\right]$