【STM32电机矢量控制】记录9——状态观测器与锁相环

状态观测器：

理论依据：根据控制理论，如果一个系统能够完全通过其检测到的输出值来重构其系统状态，则认为该系统是可观测的。其作用于无传感器转子的位置和速度的检测反馈，再作用到PARK变换和转矩磁链控制上。

Luenberger观测器的离散化：

（其观测器的闭环参数为经验验证值）

引入估测电流（ iα，iβ ）的反馈值并离散化(T 为采样时间)，可得当前的反向电动势 eα 和eβ；

再由反向电动势 eα 和eβ  的计算出转子的位置角。

可以将其定义式相除，可得到转子位置角，但是这方法是开环的，对耦合在反电动势里的干扰非常敏感，它会使反电动势成为非正弦信号）

程序中使用的是锁相环方式，以PI闭环方式调节ωr以保持其输入为0 (电角度领先反电动势一个采样时间。这样算出来的转子电角度比较稳定准确。

（PLL闭环的系数是经过验证的经验结果，没必要修改它们的值）

起动策略：

设定启动的电流幅值、频率变化阈值，而起动是否成功在于在设定起动的时间内观测器和PLL是否收敛，即转子的转速的最大变化率是否大于限定值（方差的计算）、起动的转速是否高于最小速度值

软件结构：

锁相环PLL：

1. 时钟与振荡电路

在芯片中，最重要的就是时钟，时钟就像是心脏的脉冲，如果心脏停止了跳动，那人也就死亡了，对于芯片也一样。了解了时钟的重要性，那时钟是怎么来的呢？时钟可以看成周期性的0与1信号变化，而这种周期性的变化可以看成振荡。因此，振荡电路成为了时钟的来源。

振荡电路的形成可以分两类：

1.      石英晶体的压电效应：电导致晶片的机械变形，而晶片两侧施加机械压力又会产生电，形成振荡。它的谐振频率与晶片的切割方式、几何形状、尺寸有关，可以做得精确，因此其振荡电路可以获得很高的频率稳定度。

2.      电容Capacity的充电放电：能够存储电能，而充放电的电流方向是反的，形成振荡。可通过电压等控制振荡电路的频率。

2. PLL与倍频

由上面可以知道，晶振由于其频率的稳定性，一般作为系统的外部时钟源。但是晶振的频率虽然稳定，但是频率无法做到很高（成本与工艺限制），因此芯片中高频时钟就需要一种叫做压控振荡器（Voltage Controlled Oscillator）的东西生成了（顾名思义，VCO就是根据电压来调整输出频率的不同）。可压控振荡器也有问题，其频率不够稳定，而且变化时很难快速稳定频率。哇偶，看到这种现象是不是很熟悉？嘿嘿，这就是标准开环系统所出现的问题，解决办法就是接入反馈，使开环系统变成闭环系统，并且加入稳定的基准信号，与反馈比较，以便生成正确的控制。

因此，为了将频率锁定在一个固定的期望值，锁相环PLL出现了！一个锁相环PLL电路通常由以下模块组成：

• 鉴相鉴频器PFD（Phase Frequency Detector）：对输入的基准信号（来自频率稳定的晶振）和反馈回路的信号进行频率的比较，输出一个代表两者差异的信号

• 低通滤波器LPF（Low-Pass Filter）：将PFD中生成的差异信号的高频成分滤除，保留直流部分

• 压控振荡器VCO（Voltage Controlled Oscillator）：根据输入电压，输出对应频率的周期信号。利用变容二极管（偏置电压的变化会改变耗尽层的厚度，从而影响电容大小）与电感构成的LC谐振电路构成，提高变容二极管的逆向偏压，二极管内耗尽层变大，电容变小，LC电路的谐振频率提高，反之，降低逆向偏压时，二极管内电容变大，频率降低

•  反馈回路FL（Feedback Loop）：通常由一个分频器（DIV）实现。将VCO的输出降低到与基准信号相同级别的频率才能在PFD中比较

PLL工作的基本原理就是将压控振荡器的输出经过分频后与基准信号输入PFD，PFD通过比较这两个信号的频率差，输出一个代表两者差异的信号，再经过低通滤波器转变成一个直流脉冲电压去控制VCO使它的频率改变。这样经过一个很短的时间，VCO的输出就会稳定下来。所以：

PLL并不是直接对晶振进行倍频，而是将频率稳定的晶振作为基准信号，与PLL内部振荡电路生成的信号分频后进行比较，使PLL输出的信号频率稳定

最后，根据原理，理解一下锁相环（Phase Locked Loop）的名称

1. 为了对基准信号与反馈信号进行频率比较，二者的相位必须相同且锁住，任何时间都不能改变，这样才能方便的比较频率，所以叫锁相（Phase Locked）

2. 为了快速稳定输出系统，整个系统加入反馈成为闭环，所以叫环（Loop）

在FOC控制中的锁相环：

eα、eβ为反向电动势，ωr为转子角速度，θr 为转子位置角。

PLL 闭环系数计算：

经过验证，Kp及Ki定义为：

没有必要去修改它们的值，但是如果确实有必要修改，则必须注意：

为了增加带宽(此时，对速度变化有更好的动态响应，但ωr干扰增大)，应比例地增大Kp及Ki。

主要完成任务：

1、对状态观测器算法进行学习

2、根据PMSM FOC 2.0 用户手册，对程序的各个函数进行梳理注释，理解其编程配置步骤