FOC控制原理完整.docx

FOC 控制原理FOC控制原理简介电机分为有刷电机和刷电机，这主要描述的FOC控制算法主要是针对刷电机的控制，刷电机于飞器或者四狗、机械臂 等这种精度的环境当中。玩过四轴的都较清楚在，四轴飞器中般采电调的驱动式，那么电调和FOC直接有什么优缺点呢？电调较适于电机告诉旋转的场景，对低速的控制确实乏，FOC论在速还是低速的场景下都适FOC途之，如下的狗：. 电机的旋转原理1. 电机旋转的基本知识磁铁的分N和S级，同性相斥异性相吸的原理，那么将两个磁铁放在起会出现什么现象呢？如下图，若拖动下的磁铁进旋转，那 么由于磁场的原因，上的磁铁也会跟着进旋转那么两个磁铁在何时矩(矩在物理学是指作使物体绕着转动轴或点转动的趋向)最呢？如下图，当两个磁铁呈直时， 矩最(可以简单的认为相互作最)。当将上两个磁铁中下的磁铁换成电磁铁，电磁铁是物理不旋转是形成的磁场的进旋转，那么是不是与上的效果样，带动另个 磁铁进旋转2. 电机旋转的式a.电磁铁的构成单个通电线圈如下图所，由右螺旋定理可以得出该线圈磁场的向是向上的，那么这只有个向的磁场，那么如何增加旋转磁场的向呢？简单的办法就是增加线圈，并且线圈的朝向不同即可，这我们以 三相电机为例进描述，三相电机就是采如下图的式，采三个线圈，每个线圈的向间隔120度由于减少硬件电路驱动(H桥)的数量，因此般是将三个线圈的端进相连接，组成了三相星型结构，如下图，那么为什么会这样链接 呢？每个线圈单独供电是否可以呢，当然是可以的，具体原因下会描述b.H桥驱动电路驱动线圈驱动线圈供电，般使H桥驱动电路，那么我们先看下如何驱动个线圈的，如下图H桥由4个MOS管组成，当 A 和 B 打开时，电流由左上流线圈经由B流负极，也就是图上的红箭头的向，同理打开B 和A'同时打开，电流就是蓝箭头的向，这样就能控制线圈产不同向的磁场了。那么如何控制上线圈产的磁场的呢？转换来看也就是如何控制加在线圈两侧的电压的呢？这可以使波来控制MOS管的导通，如时间周期T，在T/2时间打开A和B'，剩下的T/2关闭A和B'，这样的话就相当于0.5VDC的电压加载到线圈上了(若是T时间均打开 那么线圈上的电压就是VDC)，线圈上的电压可能是00.5VDC之间不断的跳动，但是线圈的电流是接近连续的，因为这是电感，如下图，若是电压变动很快并且电感够，理论上是可以做到电流连续的由上的H桥驱动电路可以知道，个H桥由4个MOS管构成，那么若是三个线圈就需要12个MOS管构成，这样常的浪费，*这也是为什么要将三个线圈连在起组成星链结构的原因*。ps:在上的H桥驱动电路上桥臂和下桥臂在同时间只有个能打开，这是为什么呢？因为两个同时打开就短路了。所以这种情况是不允许 发的。正是为了避免上的情况发，所以才有了*死区*时间的概念，死区时间是PWM输出时，为了使H桥或半H桥的上下管不会因为开关速 度问题发同时导通设置的个保护时段，所以在这个时间，上下管都不会有输出。那么H桥驱三相星链线圈是怎么样呢？如下图：定义MOS管开关状态如下：上桥开通下桥关断定义为状态1 上桥关断下桥开通定义为状态0这样，三组半桥就共有8种组合式，编码分别为：*000*、*001*、*010*、*011*、*100*、*101*、*110*、*111* c.三相线圈产的磁场0电流状态：上的8种组合中有000和111状态，较明显看出当在这两个状态时三相线圈是没有电流经过的，这个状态我们称为0电流状态。上的8种状态除去两个0电流的状态，其余6种都会产磁场，并且相应的磁场向分别为：其中橘箭头的向和电磁铁形成磁场向致，但是这我们把橘黄箭头称呼为*电压量的向*，因为这我们加载的是电压向（1图中A指向B和C）由于是稳态的，所以电流向也是这个向，所以磁场向和橘箭头致了<右螺旋法则>。所以最终产的 磁场向汇总如下：d.电磁场牵引转最优的状态在上已经提到当电磁铁的向和转(永久磁铁)的向呈90度的时候，矩最，如下图，此时转会向着电磁铁的向旋转,此时若转受到牵引转动了，与此同时电磁铁也按照同向转动了，那么电磁铁的向始终和转的向垂直，这样转就会不断的进旋转了并且矩始终是最的，这就好下图：*驴直跟着胡萝的位置进转动，但是驴 和胡萝的位置确不会被改变*现在我们已经知道我们需要的是什么了？*那就是个旋转任意度的磁场并且可控*，但是由上描述三相线圈只能成6个向的电 压量(电压量的向和磁场向相同)，那么如何根据这6个电压量合成任意度的电压量(磁场向)呢？这就是SVPWM要的事情了SVPWM：空间量脉宽调制(Space Vector Pulse Width Modulation) SVPWM的基本思想就是根据上6个磁场向的来合成任意度的磁场向a.量的合成初中数学的知识回顾如下我们想产（0，1）的量，其实可以看作是 ：1可以看作周期T的时间内有T这么长时间作在X轴上，Y轴作时间0 我们想产（1，0）的量，其实可以看作是：我们想产（0.5，0.5）的量，其实可以看作是：其中这0.5可以看作周期T的时间内有0.5T的时间作在X轴上，也有0.5T的时间作在Y轴上； 根据上的例，我们可以固定这样的表达式那么若是想产(0.25,0.25)这个向的量，该如何表达：这加了零向量，这向量(0.25,0.25)和向量(0.5,0.5)向相同，但是赋值不样，但是总时长加起来还是1*可以得出句话就是幅度要低，拿0来抵<上的000和111状态派上了场>*。b.SVPWM中的电压量合成在这我们可以认为电压量向和磁场向相同(*因此本节也可以理解为磁场向的合成*)量控制，就是要通过6个向的空间量电压作为基向量来合成任意量，基向量的选择是选择当前扇区的两个基向量。 这我们以第扇区为例，当前需要合成的度为，对应的基向量分别为U6和U4，如下：由上图可以看出，通过U4和U6显然是能够合成Uref的，将要成的Uref向量分别投影到U6和U4上，由正定理(*各边和它所对的正弦值的相等*)可以得出如下恒等式：(T6/T)*U6：可以理解为要产Uref这个电压，U6要产多少电压因为|U6|=|U4|=2Udc/3(Udc是供给电压，由欧姆定律计算得出)，因此可以得出如下T4和T6的时间：其中参数m表为SVPWM的调制系数(调制)：上已经描述过，因为我们需要根据需要控制幅值，因此需要零量的参与，因此零量的时间为 总时间T减去T4和T6的作时间：这为什么是1/2，是因为我们要插两个零量，所以时间要平分给两个零量，那么为什么要插两个零量呢？只个零 量可以吗？理论上是可以的，但是会对MOS管的开断会产较的影响，影响MOS管的寿命，所以我们希望尽量减少MOS管的开关次数，因此前设计出了7段式SVPWM的调制法，如下：解释下该图的参数，A、B、C代表的是H桥驱动电路上的控制端信号，同时我们通过在合理的位置插两个零量，并且对零量在时间上进了平均分配，以使产的PWM对称，从有效地降低了 PWM的谐波分量。同理可以得出其他扇区的切换顺序如下，为什么有这样的顺序呢？*对应到MOS管的开关上来看就是每次状态的切换只要个MOS进切 换，极的降低了MOS管的损耗*重新回到上的T4和T6的公式中，得出的公式如下：其中因此到这，SVPWM的作完成了，我们得到了每时刻所需要的空间电压量以及它们持续的时间，在处理器中赋值给对应通道的捕获较寄存器产相应的三个PWM波形，控制MOS管的开关，*进产我们期望的电压、电流、矩。*但上的公式在实际的控制中并不使，因为其还是太过于复杂，因为牵扯到了度的变化，该种算法是式的SVPWM的思路，那么现在 是如何得到每个向的Tx(基向量的作时间)呢？如下节：c.SVPWM和FOC的联系那么FOC和SVPWM是如何对接的？先理解前后关系：FOC的输出是SVPWM的输，SVPWM输出是三相电压的占空，也就是最终设置到计时器中的较寄存器的值。那么FOC输出的是什么呢？因为后会介绍，所以这直接给出结论是V和V，这个也与直轴和交轴向相同的两个电压量直轴：转N到S的向交轴：与直轴垂直，维持转转动的向 ，在电机转动的过程中，交轴向的是维持转转动的，直轴上的对转动效果，因此我们应该尽让其为0.那么该处假定已经知道了FOC输出的V和V，那么该如何得到T4、T6、T0、T7，从更新寄存器控制PWM的输出呢？ 继续贴出上讨论的在第象限的Uref，如下(Ts和上图中的T是个意思，都是表PWM输出的完整周期时间)：电压量U4(100)和U6(110)的Uout，分别是2/3Udc和2/3Udc*（cos(/3),sin(/3) ->量1.先上式表的是U4和U6向的总电压，这个电压如何计算得出来的呢？三相线圈的等效电阻如下：由上的电路我们可以根据电路原理和量合并等原则算出各个向输出的电压，这不再进计算直接给出结论，如下图：其中红框标出来的就时第象限所需要的U6和U4的总电压其中U4(1,0,0)=2/3Udc(向)，U6=2/3Udc *e(j* /3)，这是个量表达形式，我们将其变下形： 根据虚数变换公式可以将e(j* /3) = cos(/3) + j*sin(/3)，坐标表则就是*(cos(/3) ，sin(/3)），这样就很清晰了，其表的是和轴对应的值， 那么FOC输出的就是和轴向的值，这样就能得到了上的值。我们将U4和U6分和Uref别投影到和轴上，那么就会出现如下恒等式：那么由左侧和右侧等式可以得出如下公式：其中例系数为*K* =3*Ts*/Udc ，该是个固定的值。因此上就建了T4、T6、T0和T7与FOC输出的U、U的关系了。上仅限于第区域的计算公式，其他扇区的公式不进推倒，直接给出结论：这样我们拿到FOC的输出结果U、U，然后执如下步骤： 1.根据该值判断合成的量所在的扇区2.然后利对应扇区的公式计算Tx、Ty、Tz等值，然后进变换后设置到PWM控制器的较值中，即可产我们想要的波形，从产定向的磁场向这样就能完成电机的量控制,SVPWM的作就已经完成了上已经得到根据FOC的输出能够很轻易的得到需要设置寄存器的值以来控制电机，那么下我们来分析这个FOC是如何得到这个U、U的.FOC控制原理当我们拿到个三相刷电机时，当转动电机然后波器观察电机的三根信号线，能够看到输出的是三个相位相差120度的正弦 波形，因为电动机反过来就是发电机。因为控制常的就是闭环控制，检测正弦波较困难，那么FOC主要做的作就是解耦，就是将复杂的信号拆解成较容易分析的量1.FOC控制的 Pipeline这幅图是以电流闭环控制为例的，也就是让电机始终产个恒定的矩（也就是恒定的电流，因为矩和电流成正）。可以看到控制器的输是最左边的Iq_ref和 Id_ref，两个变量经过PID控制器进反馈调节，其中还涉及到个变换模块，*有Park变换和Clark变换*；最后通过前提到的SVPWM模块作到三相逆变器上进控制电机；PID控制器的反馈量，是对电机输出电流的采样值。FOC控制的整个过程是这样的：1. 对电机三相电流进采样得到Ia Ib Ic2. 将Ia、Ib、Ic经过Clark变换得到I I3. 将I I经过Park变换得到Iq和Id4. 计算Iq和Id和其设定值Iq_ref，Id_ref 的误差5. 将上述误差输两个PID（只到PI）控制器，得到输出的控制电压Uq，Ud6. 将 进反Park变换得到U，U7. U，U合成电压空间量，输SVPWM模块进调制，输出该时刻三个半桥的状态编码值8. 按照前输出的编码值控制三相逆变器的MOS管开关，驱动电机9. 循环上述步骤2.Clark变换通过电流的采样，我们得到了三个相位相差120度的正弦波，采集电机前的电流的作主要是作PID反馈，以此来调整输的误差。 从上图可以看出，我们只需要采样两个信号线，另根可以使基尔霍夫定律得出(在任时刻，流节点的电流之和等于流出节点的电流 之和，也就是说Ia + Ib +Ic = 0那么将三相正选波形直接作为PID，那么这个过程常的复杂，因此我们这些算法对其进转换，将采集的三相电流表如下图：其中横坐标表为轴，纵坐标表为轴，那么此时将Ia、Ib、Ic分别投影到和轴上，就能较轻易的得到如下恒等式：经过这样的投影，我们将Ia、Ib、Ic转换成了I和I 两个变量了，可能这样还不够直观，我们从波形上看看到底有什么变化：从上图可以看出经过上的变换后，需要控制的变量从3个编程了2个了,这样的转换就称为Clack变化，但是这两个还是正弦波形，还是不 好做跟踪不好做处理，最理想的跟踪变量是什么呢？肯定是直线了，下我们沿着Clack变换继续进处理。4. Pack变换在上的Clack的输出中得到了*-坐标系* ,若是将该坐标系旋转，如下：经过旋转后Q-D坐标系可以表成如下：Q和D可能很熟悉，那就是分别对应电机的Q轴(交轴)和D轴(直轴)，就是转转动的度，也就是d-q坐标系是始终随着转进转动的。 这个操作是可的，因为我们会通过编码器输转的实时旋转度，所以这个度始终是个已知数。经过这步的变换，我们会发现，个匀速旋转向量在这个坐标系下变成了个定值！*（因为参考系相对于该向量静了，Id和Iq相对于D-Q坐标系）*，这个坐标系下两个 控制变量都被线性化了！接下来如果我们以 Iq和Id 这两个值作为反馈控制的对象，那么显然就可以使些线性控制器来进控制了，*如PID*5. PID控制PID是在控制领域最常的算法之，这不做过多的介绍，只介绍下PID在FOC控制系统当中的应：在FOC控制中主要到三个PID环，从内环到外环依次是：*电流环*、*速度环*、*位置环。*也就是说：我们*通过电流反馈来控制电机电流（扭矩）* -> 然后*通过控制扭矩来控制电机的转速* -> 再*通过控制电机的转速控制电机位置*。a.电流环从上图可以看出，我们上的系列的操作运算，如clack变换和pack变换最后输出的Iq和Id的值，也就是主要对采样的正弦电流进解 耦，分解成径向和切向这两个向的变量：- 其中 Iq是我们需要的，代表了期望的矩输出- Id是我们不需要的，我们希望尽可能把它控制为0*由上图可以知道经过FOC的控制标就是将Id的电流尽量减到0，因为其对电机的转向是没有任何帮助的所以我们尽量让其控制到0* b.速度环w是电机的转速反馈，可以通过电机编码器或者霍尔传感器等计算得到，依然是使*PI控制*。注意这的w转速并不是瞬时的速率，是测了段时间取平均值的速率，因此若是在低速的情况下，速率环就不那么适了，因为平均测 速法会存在常的误差（转不动或者动地很慢，编码器就没有输出或者只输出1、2个脉冲）。c.位置环由于去掉了速度环，这的位置环我们使*完整的PID*控制，即把微分项加上（因为位置的微分就是速度，这样可以减位置控制 的震荡加快收敛；积分项的作是为了消除静态误差）。到前为，FOC控制刷电机的驱动式已经基本讲解完了，有了以上的内容就能够常妥善的控制电机运转，但FOC还有部分内容，那就是能量回收，该部分放到以后进分享三、参考章STM32参考程序： SVPWM：些开源的项：MIT的机器狗的参考code