【自制FOC驱动器】深入浅出讲解FOC算法与SVPWM技术

转载自 http://www.pengzhihui.xyz/2020/07/02/foc/

1. 前言前阵子工作太忙，好久没做个人项目了，最近久违地想做一个机器人项目，设计中需要用到高性能超小体积的伺服电机。

0. 前言

前阵子工作太忙，好久没做个人项目了，最近久违地想做一个机器人项目，设计中需要用到高性能超小体积的伺服电机。

电机这一块性能满足项目需求的基本上只有无刷电机可以选了–又要大功率、大扭矩，又要体积小，成本还最好不要太高，选择低 KV 值的无刷电机显然是最合适的。我预计的方案中计划把减速器也省略了，采用扭矩无刷电机直驱。那么作为机器人硬件三大核心部件（电机、减速器、驱动器）之一的驱动器，我感觉是有必要自己设计一下的，因此这里把我学习 FOC 过程中看到的一些有关无刷电机矢量控制的资料和个人理解整理分享出来。

0.1 什么是 FOC？

FOC（Field-Oriented Control），直译是磁场定向控制，也被称作矢量控制（VC，Vector Control），是目前无刷直流电机（BLDC）和永磁同步电机（PMSM）高效控制的最优方法之一。FOC 旨在通过精确地控制磁场大小与方向，使得电机的运动转矩平稳、噪声小、效率高，并且具有高速的动态响应。

简单来说就是，FOC 是一种对无刷电机的驱动控制方法，它可以让我们对无刷电机进行 “像素级” 控制，实现很多传统电机控制方法所无法达到的效果~

0.2 FOC 驱动器和无刷电调的区别

玩过航模的同学可能对无刷电机很熟悉，也应该知道航模中对于无刷电机的驱动使用的是电子调速器（ESC）也就是我们常说的电调，那么这个 FOC 驱动器和普通的电调有什么区别呢？

航模中的无刷电调

FOC 的优势：

1. 低转速下控制
   
   由于控制原理的区别，无刷电调只能控制电机工作在高转速下，低速下无法控制；而 FOC 控制器则完全没有这个限制，不论在什么转速下都可以实现精确控制。
2. 电机换向
   
   同上面的理由，由于电调无法反馈转子位置，因此很难实现电机正反转的换向（当然有感电调可以实现）；而 FOC 驱动器的换向性能极其优秀，最高转速下正反转切换可以非常顺畅；此外 FOC 还可以以能量回收的形式进行刹车控制。
3. 力矩控制
   
   普通电调都只能控制电机转速，而 FOC 可以进行电流（力矩）、速度、位置三个闭环控制。
4. 噪音
   
   FOC 驱动器的噪音会比电调小很多，原因是普通电调采用方波驱动，而 FOC 是正弦波。

电调的优势：

1. 兼容性
   
   电调驱动不同的 BLDC 不需要进行参数整定，而 FOC 需要。
2. 算法复杂度
   
   电调的算法实现更简单，运算量少，很适合需要提高带宽的超高转速电机。
3. 成本
   
   电调的成本比 FOC 低很多。

综上大家应该可以看出来，FOC 驱动器在控制性能上是要比电调强大得多的，其优异的性能和磁场定向控制的原理是密不可分的，下面就会详细介绍 FOC 控制的实现方法。

1. 从电机原理说起

1.1 一些基础知识

1. 左手定则
   
   用于判断导线在磁场中受力的方向：伸开左手，使拇指与其他四指垂直且在一个平面内，让磁感线从手心流入，四指指向电流方向，大拇指指向的就是安培力方向（即导体受力方向）。

1. 右手定则
   
   伸开右手，使大拇指跟其余四个手指垂直并且都跟手掌在一个平面内，把右手放入磁场中，让磁感线垂直穿入手心，大拇指指向导体运动方向，则其余四指指向感生电动势的方向。也就是切割磁感线的导体会产生反电动势，实际上通过反电动势定位转子位置也是普通无感电调工作的基础原理之一

1. 右手螺旋定则（即安培定则）
   
   用于判断通电线圈判断极性：用右手握螺线管，让四指弯向螺线管中电流方向，大拇指所指的那端就是螺线管的 N 极。直线电流的磁场的话，大拇指指向电流方向，另外四指弯曲指的方向为磁感线的方向。

1. PWM（脉冲宽度调制）

不同占空比的 PWM 波形

本质是利用面积等效原理来改变波形的有效值。举个例子，一个电灯只有开和关两个状态，那么要怎么让它实现 50% 亮度的效果的呢？只需要让它在一半时间开，一半时间关，交替执行这两个动作只要频率足够高，在人眼（低通滤波器）看起来就是 50% 亮度的样子了。而其中高电平占一个开关周期的比例，就叫做占空比。利用 PWM 可以实现使用离散的开关量来模拟连续的电压值。

1.2 无刷电机原理

考察下图情况中的直流电机基本模型，根据磁极异性相吸同性相斥的原理，中间永磁体在两侧电磁铁的作用下会被施加一个力矩并发生旋转，这就是电机驱动的基本原理：

对于简化的无刷电机来说，以三相二极内转子电机为例，定子的三相绕组有星形联结方式和三角联结方式，而三相星形联结的二二导通方式最为常用，这里就用该模型来做个简单分析：

如上图所示，无刷电机三相的连接方式是每一相引出导线的一头，而另一头和其他相两两相连。这个情况下假如我们对 A、B 极分别施加正电压和负电压，那么由右手螺旋定则可以判断出线圈磁极的方向如下图：

思考一下这时候中间的转子处于什么角度的时候收到的力矩最大呢？

没错就是和 CO（O 为中心点）连线平行的时候，磁铁会受到 A、B 两个磁极一推一拉的作用，直到旋转到与 AB 连线平行的且磁铁内部磁力线方向和 AB 间磁力线方向一致的时候，受合力矩为 0 且稳定，也就是上图中右边的状态。换句话说，AB 相通电会让转子努力转到上图中右边的状态。至于 C 这时暂时不起作用。

同理，我们下一阶段换成 AC 相通电，这时候转子会倾向于转到下图右边水平的角度：

然后 BC 相通电：

…

以此类推，可以得到每个通电状态下转子的角度，就是下图中的 6 个状态，每个状态相隔 60 度，6 个过程即完成了完整的转动，共进行了 6 次换相：

整个过程就好像骑在毛驴上吊一根胡萝卜一样，旋转的磁场牵引着永磁体不断旋转：

而这个换向的操作，就是需要驱动器去完成的。

这也是无刷电机和有刷电机最大的区别，即不像有刷电机的机械换向，无刷电机是通过电子换向来驱动转子不断地转动，而换向的频率则决定了电机的转速。

至于什么时候怎么知道该换到哪个供电相？如何产生更平滑的换向电压？如何提高电源的利用效率？这些都是 FOC 控制方法要探讨和解决的问题。

1.3 关于 BLDC 和 PMSM 的区别

无刷电机其实可以分为无刷直流电机（BLDC，我们航模上都是用这种）和永磁同步电机（PMSM），结构大同小异，主要区别在于制造方式（线圈绕组方式）不同导致的一些特性差异（比如反电动势的波形）。

从上面分析的无刷电机模型其实可以看到，由于转子在磁场中只有 6 个稳定的状态，因此旋转过程其实是不平滑的，存在扭矩的抖动（没有通电的时候可以用手转一下无刷电机，会感受到这种 “颗粒感”）。因此为了解决这个问题，从“硬件” 和从 “软件” 出发有两个解决方案，这就衍生出了 BLDC 和 PMSM 的区别。

简单地说，BLDC 由于反电动势接近梯形波，所以依然是采用方波驱动，肯定是会有上面说的抖动问题的，但是转一圈抖 6 下太明显了，如果我增加电机槽、极对数（也就是磁铁对数），那以前是 360 度里面抖 6 下，现在变成 120 度里面抖 6 下，甚至更小，这样 “颗粒感” 不就变得更小了嘛？实际中买到的 BLDC 电机基本都是多极对的（比如下图），原理跟之前的分析是一样的，出来的都是三相信号（图中的三根线），可以自己进行类推。

而另一方面，为什么我们非得用方波这种不平滑的波来驱动电机呢，用正弦波它不香吗？是的，这就是 PMSM 解决问题的方式，由于 PMSM 的反电动势被设计为正弦波的形状，我们用软件和算法结合 PWM 技术将方波转变成等效的正弦波，再来驱动电机，结果美滋滋，控制效果很理想。当然为了产生更好的正弦波、更好的旋转磁场，驱动器、控制算法就变得非常复杂，这也是 FOC 的实现原理，后面会进行详细介绍。

1.3 驱动电路实现

无刷电机的驱动电路主要使用三相逆变电路来实现，如下图：

所谓逆变电路，即把直流电变换为交流电，或者简单点说就是一个可以产生不同电流流向的电路，通过前面的电机模型分析我们也可以看出，对于无刷电机的驱动是需要在不同时刻施加不同方向的电压（电流）的，因此需要逆变电路。

而逆变电路具体的实现则一般是采用半桥 MOS 电路来制作的。半桥电路的原型如下，其实很简单，就是两个 MOS 管组成的上桥臂和下桥臂，中间引出一条输出线：

用 3 个半桥电路就可以组合成三相逆变电路，每个半桥引出的一根输出线跟无刷电机的一根相线相连，就完成了最基本的无刷驱动电路。

原理方面，MOS 管可以看作电压控制的高速电子开关，在 MOS 管的栅极（上图中的 High Drive 和 Low Drive）施加高电平或者低电平，就可以控制 MOS 源极和漏极的导通或者关闭。比如在下图中，我们打开第一组半桥的上桥臂、第二组和第三组半桥的下桥臂（其余的关闭），那么就可以让电流从电源正极流过电机的 a 相，流经 b、c 相，然后回到电源负极：

三相逆变驱动电路

于是通过控制三个半桥的不同开关状态，我们可以控制电流在电机中的不同流向了。

注意，在这个电路中，每个状态下电机的三相线圈都会有电流；而在上一节的示例中我们同一时刻只会让两相线圈有电流，另一相不起作用。

那么这么修改的原因是啥呢？当然是：浪费可耻啊~

浪费一相不用那不就白白损失了一部分扭矩嘛？通过上图中的方式驱动原理也是和之前分析一致的，但是可以产生更大的扭矩，所以当然是更好的选择啦。

接下来我们将半桥电路的状态做一个编码，首先限定一个半桥只有两种状态：

• 上桥开通下桥关断定义为状态 1
• 上桥关断下桥开通定义为状态 0

这样，三组半桥就一共有 8 种组合方式，编码分别为：000、001、010、011、100、101、110、111，记住这点，后面会用上~

可能有人会问，为什么一个半桥只能上桥臂和下桥臂有一个导通呢？都关闭或者都导通不行？？

害，仔细想想就知道，上下都导通显然是不可能的，因为这就相当于把电源短路了啊…

那上下都断开呢？也不需要，因为这样就回到前面提到的，这时候电机有一相不起作用，浪了个费。

实际上半桥驱动电路的实现会比上面的分析要复杂一些，比如需要考虑开关管的开关频率、开启和关断时间不对称、死区问题等等，我后面设计的 FOC 驱动使用的是专用的半桥 MOS 栅极驱动 IC 来实现的。

1.4 旋转的三相电机波形

按照前面的无刷电机基本模型，假设我们拿到这样一个电机，手动匀速转动它的转子，然后用示波器观察它的三相输出电压（也就是反电动势产生的电压），会看到什么波形呢？

其实很自然可以想到，我们会得到 3 根正弦曲线，而且三根曲线两两相位差为 120°：

实际上三相发电机的发电原理就是这样的，输出的就是三相幅值为 220V 的交流电（线电压为 380V，即 V）。

发电机反过来就是电动机啦，所以假如反过来我们在三相无刷电机的三相线圈上输入上述三相正弦电压，那么就可以驱动无刷电机平稳高效地旋转了。

而这也是 FOC 驱动无刷电机的基本手段，即通过计算所需电压矢量，使用 SVPWM 技术产生调试信号，驱动三相逆变电路，合成出等效的三相正弦电压驱动电机。

这个会在后面进行详细介绍。

2.FOC 控制原理

ok 基础知识铺垫完毕，终于要进入正题啦~

大家刚开始接触 FOC 查阅相关资料文献的时候，可能都会感觉有点晕：

为什么要做各种变换和反变换？

空间矢量到底代表了啥？？

不同扇区内为什么非得是这样的状态切换顺序？？？

…

不要担心，某奥力给曾经说过：战胜恐惧的最好方法就是面对恐惧。

下面就由我尝试深入浅出为大家拆解一下 FOC 控制，带大家直面矢量控制的核心原理~

2.1 FOC 算法的 Pipeline

我们先来看一下 FOC 控制的整个流程图景：

稍微解释一下，这幅图是以电流闭环控制为例的，也就是让电机始终产生一个恒定的力矩（也就是恒定的电流，因为力矩和电流成正比）。

可以看到控制器的输入是最左边的 \(I_{q}-ref\) 和 \(I_{d}-ref\) ，两个变量经过PID控制器进行反贵调节，其中还涉及到几个变换模块，有 Park变 换 和 Clark变换；最后通过前面提到的 SVPWM模块 作用到三相逆变器上进而控制电机；而PID控制器的反馈量，是对电机输出电流的采样 值。

上面的过程不好理解没关系，先概括一下，FOC控制的整个过程是这样的:

1. 对电机三相电流进行采样得到 \(I_{a}\), \(I_{b}\), \(I_{c}\)
2. 将 \(I_{a}\), \(I_{b}\), \(I_{c}\) 经过 Clark变换 得到 \(I_{\alpha}\), \(I_{\beta}\)
3. 将 \(I_{\alpha}\), \(I_{\beta}\) 经过 Park变换 得到 \(I_{q}\), \(I_{d}\)
4. 计算 \(I_{q}\), \(I_{d}\) 和其设定值 \(I_{q}-ref\) 和 \(I_{d}-ref\) 的误差
5. 将上述误差输入两个PID (只用到PI) 控制器，得到输出的控制电压 \(U_{q}\), \(U_{d}\)
6. 将 \(U_{q}\), \(U_{d}\) 进行 反Park变换 得到 \(U_{\alpha}\), \(U_{\beta}\)
7. 用 \(U_{\alpha}\), \(U_{\beta}\) 合成电压空间矢量，输入 SVPWM模块 进行调制，输出该时刻三个半桥的状态编码值 (前文有提到)
8. 按昭前面输出的编码值控制三相逆变器的MOS管开关，驱动电机
9. 循环上述步骤

下面我们来分别介绍每一步的具体操作以及意义。

2.2 Clark 变换与 Park 变换

前面分析了，如果要平稳地驱动三相电机转动，我们就需要生成三个相位相差 120 度的正弦波，但是我们最终的控制对象是 MOS 管的开通和关断，只有电压最大值和 0 值两个状态啊，怎么去生成连续变化的正弦波呢？

对了，用前面提到的 PWM 技术就可以做到，所谓 SPWM 就是这么干的，如下图：

大家观察一下上图的波形，我们用上面坐标系中的正弦波和三角波的交点投影到下面的坐标轴，以此确定 PWM 的占空比变化规律，这样合成的 PWM 波，经过低通滤波器之后，其实就等效为了一个正弦波！所以 SPWM 就是在 PWM 的基础上用正弦波来调制合成的具有正弦波规律变化的方波。

这不是很理想吗？不对，我们在 FOC 控制中并不会采用 SPWM 的调制方式。

最主要的原因是，通过上面三个半桥逆变器电路的分析我们可以知道，我们并不好在某一时刻独立地控制某一时刻电机的三个相电压，也就很难合成三路这种 SPWM 波了；另外 SPWM 也比后面要说的 SVPWM 的电压利用率要低 15%（具体怎么算的这里就不介绍了）。

另一方面来看，我们甚至根本就不想跟什么三个正弦波打交道！

因为要对于非线性的信号进行准确控制就要使用复杂的高阶控制器，这对于建模成本、处理器算力、控制实时性等都是不利的。简单地说就是，咱们控制器的反馈输入变量不是三个电流采样值嘛，你要我稳稳地跟踪三个正弦波太麻烦啦！能不能简单点跟踪一条直线（常量）啊？

答案是可以的~ 只需应用一点数学小技巧

Clark 变换

我们回到上面 FOC 控制过程 9 个步骤的第 1 步，也就是对电机的三个相电流进行采样，这一步会使用串联的采样电阻（Shunt）进行电流采样。

由于电机工作的电流一般很大，所以采样电阻的阻值非常小，甚至和导线的电阻接近了，因而实际的采样电路 PCB 设计的时候还有一些讲究，比如使用开尔文接法 (Kelvin connections)。

但是我们实际电路设计时不会使用三个采样器，只需要两个就够了。因为由基尔霍夫电流定律（KCL），在任一时刻，流入节点的电流之和等于流出节点的电流之和，也就是说

只需要知道其中两个就可以计算出第三个了。

这三个电流基本上就是三个相位相差 120 度的正弦波，在把这些信号输入控制器反馈控制之前，我们先来做点数学游戏：

我们知道三相坐标系 如下：

问题：这明明是一个二维平面内的坐标系，为啥要用 3 个坐标轴来表示呢？

而且很明显 这三个基向量是非正交的，学过线性代数的同学可能会想到，我们可以做一个很简单的基变换将其正交化为一个直角坐标系，我们把新的直角坐标系命名为 **** ** 坐标系 **，变换公式如下：

其实就是个很简单的坐标轴投影计算，写成矩阵形式如下：

于是我们就回到直角坐标系啦，是不是很开心，变换前后的波形如下：

可以看到变换后其实还是正弦波… 只不过我们少了一个需要控制的变量了，现在只需要控制 这两个变量，让其满足上图的下面的波形变化规律就可以控制电机旋转 了，频率还是不变的。

注意这里的 是我们虚拟出来的变量，所以在计算出一组 后，我们通过上述公式的反向变换公式变换回去再应用到电机的三相上。

就这？

当然不是，如果只是为了减小一个控制变量那这个变换 / 反变换操作显然有点多此一举。

有趣的是我们还可以接着变换：虽然 坐标系下少了一维变量，但是新的变量还是非线性的（正弦），有没有办法把它们线性化呢？有的，Park变换就是做这个工作的。

Park 变换

这一步中我们接着Clark变换将 坐标系旋转 度，其中 是转子当前的角度，如下图：

变换公式如下：

也很简单，就是作用了一个旋转矩阵，写成矩阵形式：

也就是说，这个 **** ** 坐标系 ** 是始终跟着转子旋转的！

这个操作是可行的，因为我们会通过编码器输入转子的实时旋转角度，所以这个角度始终是一个已知数。经过这一步的变换，我们会发现，一个匀速旋转向量在这个坐标系下变成了一个定值！（显然的嘛，因为参考系相对于该向量静止了），这个坐标系下两个控制变量都被线性化了！

Park 变换前后的波形

接下来如果我们以 这两个值作为反馈控制的对象，那么显然就可以使用一些线性控制器来进行控制了，比如 PID（是的，尽管学术界有很多炫酷的高级控制方法， 但是工业界还是偏爱 PID）。

至此我们已经理解完上面 FOC 控制过程 9 个步骤的前 3 步了。

2.3 PID 控制

PID（比例、积分、微分）控制是啥这篇文章就不多讲解了，基础中的基础，也有大把文章做介绍的，不熟悉的可以自行搜索相关资料。

在 FOC 控制中主要用到三个 PID 环，从内环到外环依次是：电流环、速度环、位置环。

也就是说：我们通过电流反馈来控制电机电流（扭矩） -> 然后通过控制扭矩来控制电机的转速 -> 再通过控制电机的转速控制电机位置。

其中最内环的电流换控制框图如下：

PID 电流环

可以看出来，这也就是前面提到的 FOC 控制 9 个步骤所描述的过程。实际只用到了 PI 控制，没有引入微分，因为电流的采样率非常高不需要加入微分项。

上图中的Speed & Position模块可以是编码器，或者霍尔传感器等能感应转子位置的传感器 。

特别说明一下其中的 ，前两者大家知道是通过Clark变换和Park变换得到的，而后两者是我们预期希望前两者达到的值，这个值具体代表了什么物理量呢？参考一下下图：

也就是说我们一通操作将转子磁链进行了解耦，分解为了转子旋转的径向和切向这两个方向的变量：

FOC 的控制目标

通过 PID 控制器使用上述输入（电流采样值、编码器位置）和输出（MOS 管开关状态）完成对电机电流的闭环控制。

然后进入到下一层的速度环：

速度 - 电流双环控制

在上图中， 是速度设定值， 是电机的转速反馈，可以通过电机编码器或者霍尔传感器等计算得到，依然是使用 PI 控制。

将计算得到的电机速度 与速度设定值 进行误差值计算，代入速度 PI 环，计算的结果作为电流环的输入，就实现了速度 - 电流的双闭环控制。

最外一层是位置环，也就是可以控制电机旋转到某个精确的角度并保持，控制框图如下：

位置 - 速度 - 电流三环控制

同理应该很简单可以理解，上图中位置控制 PID 只用了 P 项（也可以使用 PI）。

在实际使用中，由于编码器无法直接返回电机转速 ，因此可以通过计算一定时间内的编码值变化量来表示电机的转速（也即用平均速度代表瞬时速度）。当电机转速比较高的时候，这样的方式是可以的；但是在位置控制模式的时候，电机的转速会很慢（因为是要求转子固定在某个位置嘛），这时候用平均测速法会存在非常大的误差（转子不动或者动地很慢，编码器就没有输出或者只输出 1、2 个脉冲）。

所以为了避免速度环节带来的误差，在做位置控制的时候可以只使用位置和电流组成的双环进行控制，不过此时需要对位置环做一定的变化，控制框图如下：

位置 - 电流双闭环控制

由于去掉了速度环，这里的位置环我们使用完整的 PID 控制，即把微分项加上（因为位置的微分就是速度，这样可以减小位置控制的震荡加快收敛；积分项的作用是为了消除静态误差）。

好了，至此整个控制回路基本上捋清楚了，但是还有一些细节我们没讲到，就是上面框图中的SVPWM模块。

细心的同学可会发现，在整个控制流程图里面有Park变换和对应的反Park变换，但是却没有Clark变换对应的反Clark变换 ，取而代之的是一个SVPWM模块。

下面会对 SVPWM 技术进行详细介绍。

2.4 空间电压矢量

什么是空间电压矢量？

空间电压矢量是我们在控制电机过程中虚拟出来的一个矢量，既然是矢量，自然是有大小和方向的，那么它的大小和方向是什么呢？

还是以前面三相逆变驱动电路那幅图中的状态为例，输入 100 的状态：

此时等效电路如图：

因此电机中三个相电压（相电压是每相相对于电机中间连接点的电压）可以表示为：

其实就是个最简单的分压电路，其中 是母线电压，也就是电源电压。

如果我们规定指向中心的方向为正，反之为负，那么此时我们可以画出下图中的三个电压矢量 （左边），以及它们的合成电压矢量 （右边）：

也就是说，这个状态下我们可以认为电机中存在一个矢量 表征的电压（电流）；然后根据右手螺旋定则，可以判断出磁场的磁力线方向，也是和矢量 一致的。

再结合前面章节的分析，转子永磁体会努力旋转到内部磁力线和外部磁场方向一致，所以这个矢量其实就可以表征我们希望转子旋转到的方向，也即所需要生成的磁场方向了。而这个矢量是会不断在空间中旋转的，它的幅值不变，为相电压峰值 ，且以角速度 匀速旋转。

我们后面将会看到，SVPWM 算法的目的，就是使用三相桥的开关状态把在空间中旋转的矢量表示出来，我们把这个矢量称为空间电压矢量。

用数学公式来表示的话就是：

为了研究各相上下桥臂不同开关组合时逆变器输出的空间电压矢量，我们定义开关函数 为：

上桥臂导通下桥臂导通

的全部可能组合共有 8 个，包括 6 个非零矢量 ：

和两个零矢量：

可以看出零矢量状态下电机三相间电压都为 0 不产生转矩（不考虑反电动势）。

下面以其中一种开关组合为例分析，假设 ，也即这张图中的状态：

如前文分析，此时的电压矢量为 AO 方向，大小为 ，我们把这个矢量画在坐标轴中如图：

ABC 坐标系和αβ坐标系下的矢量表示

注意上图中的 (100) 矢量方向和 AO 方向是相反的（变成 OA 方向），这跟正方向的定义有关，这样的规定更直观一些。

同时可以注意到两个零矢量其实和原点重合了，因为这两个状态下电机中产生力矩的磁场为 0（不考虑旋转过程中的反电动势产生的阻力力矩）。

同理，上图中还可以看出其余 5 个空间电压矢量，它们的端点组成了一个正六边形，同时把平面划分成了六个扇区（也就是图中的 Ⅰ、Ⅱ、Ⅲ、Ⅳ、Ⅴ、Ⅵ）。

那么这里问题就来了：由这 6 个空间电压矢量只能产生 6 个方向的力矩啊，我们怎么产生任意方向的力矩呢？

2.5 SVPWM 技术

既然是 “矢量控制”，当然是有办法的，答案就是：使用这 6 个空间电压矢量作为基向量来合成任意矢量。在每一个扇区，选择相邻两个电压矢量以及零矢量，按照伏秒平衡原则来合成每个扇区内的任意电压矢量，即：

\[\int_{0}^{T} U_{r e f} d t=\int_{0}^{T_{x}} U_{x} d t+\int_{T_{x}}^{T_{x}+T_{y}} U_{y} d t+\int_{T_{x}+T_{y}}^{T} U_{0}^{*} d t
\]

离散化后等效为下式:

\[U_{\text {ref }} \cdot T=U_{x} \cdot T_{x}+U_{y} \cdot T_{y}+U_{0}^{*} \cdot T_{0}^{*}
\]

式子中的 $ U_{r e f}$ 是我们期望得到的电压矢量，T是一个PWM周期。

\(U_{x}\) 和 $ U_{y}$ 分别是用于合成 \(U_{r e f}\) 的两个空间电压矢量，也就是上面说的6个基向量中的两个， 至于是哪两个? 这跟 \(U_{r e f}\) 所在的扇区有关，比如 \(U_{r e f}\) 在 I 扇区，那么 \(U_{x}\) 和 \(U_{y}\) 就是 \(U_{4}\) 和 \(U_{6}\) ; \(T_{x}\) 和 \(T_{y}\) 就是在一个周期T中 \(U_{x}\) 和 $ U_{y}$ 所占的时间。

\(U_{0}^{*}\) 指的是两个零矢量，可以是 \(U_{0}\) 也可以是 $ U_{7}$ ，零矢量的选择比较灵活，通过合理地配置 零矢量可以让空间电压矢量的切换更平顺，后面会做说明。

所以上面公式的含义就是：我们可以周期性地在不同空间电压矢量之间切换，只要合理地配置不同基向量在一个周期中的占空比，就可以合成出等效的任意空间电压矢量了。

是不是跟 PWM 的思想完全一样呢，这也是为什么这个方法被成为 SVPWM（空间电压矢量脉宽调制）。

下面举一个栗子，假设我们要合成图中所示的 \(U_{r e f}\) ，在 Ⅰ 扇区：

显然我们可以通过 \(U_{4}\) 和 $ U_{6}$ 来合成 $ U_{r e f}$ ，那么如图将 \(U_{r e f}\) 投影分解到 \(U_{4}\) 和 \(U_{6}\) 的方 向，由正弦定理有:

\[\frac{\left|U_{r e f}\right|}{\sin \frac{2 \pi}{3}}=\frac{\left|\frac{T_{6}}{T} \cdot U_{6}\right|}{\sin \theta}=\frac{\left|\frac{T_{4}}{T} \cdot U_{4}\right|}{\sin \left(\frac{\pi}{3}-\theta\right)}
\]

又因为 $ \left|U_{4}\right|=\left|U_{6}\right|=\frac{2}{3} U_{d c} $ ，所以可以计算得到 \(T_{4}\) 和 \(T_{6}\) :

\[\left\{\begin{array}{l}
T_{4}=m T \sin \left(\frac{\pi}{3}-\theta\right) \\
T_{6}=m T \sin \theta
\end{array}\right.
\]

其中m为SVPWM的调制系数 (即调制比) : \(m=\sqrt{3} \cdot \frac{\left|U_{r e f}\right|}{U_{d c}}\)

显然在电流环控制过程中m设置得越大代表了期望力矩越大。

而零矢量分配的时间为: \(T_{0}=T_{7}=\frac{1}{2}\left(T-T_{4}-T_{6}\right)\)

为什么 $ T_{0}=T_{7}$ ? 这是我们将PWM波形设定为中央对齐模式对称配置零矢量的结果，后面会提到。

现在一个周期内所有状态的持续时间我们都得到了，还差一个顺序，也就是各个状态切换的顺序。

问题：难道不是任意顺序都可以嘛？反正是做积分，重要的是持续时间而不是顺序，一个周期内怎么切换都行啊。

是的，理论上任何切换顺序都是 ok 的，但是实际中我们需要考虑更多限制，比如因为 MOS 开关次数是有寿命限制的，我们希望能尽量减少 MOS 管的开关次数，那么以最大限度减少开关损耗为目的，我们就可以设计出下面的切换顺序：

上图中可以看出来，在每个状态切换的时候，都只有一个相发生了转变：000->100->110->111->110->100->000，这也是所谓的七段式 SVPWM 调制法。

同时我们通过在合理的位置插入两个零矢量，并且对零矢量在时间上进行了平均分配，以使产生的 PWM 对称，从而有效地降低了 PWM 的谐波分量。

同理，我们也可以列出在其他扇区时的切换顺序：

至此，SVPWM 的工作完成了，我们得到了每一时刻所需要的空间电压矢量以及它们持续的时间，在处理器中赋值给对应通道的捕获比较寄存器产生相应的三个 PWM 波形，控制 MOS 管的开关，进而产生我们期望的电压、电流、力矩。

总结

至此 FOC 的原理和整个控制链路都讲完了，回想一下整个过程，再尝试解答最开始提到的问题：为什么在 FOC 控制中要做这么多变换和反变换？

因为所谓的 “矢量控制” 其实就是在做解耦，把相互耦合的三相磁链解耦为容易控制的交轴 \(I_q\) 和直轴 \(I_d\) 。整个过程就好比我们在做信号处理的时候，通过 FFT 把信号变换到频域进行处理之后再 IFFT 反变换回时域是一个道理。

另外值得一提的是，本文介绍的是有感的 FOC 控制方法，其实 FOC 可以做到无感控制（也就是不需要编码器等额外的传感器），当然控制算法也会更加复杂，需要引入前馈控制、观测器等概念，无感的好处就是结构安装更简单，可以避免位置传感器失效的风险等等，当然这又是另外一个话题了。

FOC 是个强大的控制方法，通过对电机的 “像素级” 控制，可以实现很多应用，因为可以做“力控”，FOC 是很多机器人驱动单元的基础部件，比如：

MIT Mini Cheetah 四足机器人

又比如，因为可以做到力矩的精确控制，我们可以用 FOC 驱动器配合无刷电机来实现各种力回馈装置，这就好像 iPhone 的 Haptic Engine 一样，可以模拟出各种以假乱真的物理效果：

罗技的力回馈方向盘

最后顺便提一下，我最近也在设计一个 FOC 矢量驱动器，熟悉我的同学应该知道我做东西的风格就是–唯小不破，因此这次也是准备设计一个超迷你的高性能 FOC 驱动器。硬件已经基本完工了，电路设计如下图，分为上下叠板设计，将逻辑单元和功率单元分开：

逻辑控制板

功率输出板

最后组装起来是这样的：

同时我也给驱动器设计了个外壳（毕竟颜值就是正义啊~）：

关于这个驱动器的具体参数和功能呢，等我硬件加工好了再来更新~

2020.9.5 更新，FOC 驱动器做好啦~