15万转无感FOC: 高压风机水泵吸尘器,冰箱空调压缩机

从黄色估算角度的曲线来看，角度很快就收敛了。
启动10ms 左右角度就收敛了。这个图一大格200ms，只有开头的一点点时间，角度不准确，几乎看不出来。

观测器函数M451_FOC_Reckon()总在执行，只是在磁铁不转时，估算出的磁铁角度数值 Estimate_Q_Position 会大幅度跳动，数值是随机的。

电机转起来后，有了反电势，反正切估算出的角度Estimate_Q_Position 跳动幅度变小， 当数据跳动连续N 次小于某个值时(代码中可配置)，就认定磁铁角度估值准确，就是估算已收敛，变量Position_Explicit 变非0。但这时电磁场与磁铁的位置不一定是90度，可能大于90度，也可能小于90度。



起转时，电流强托，电磁场角度逐增 Angle_q += Pull_Ommega >>16;
估算收敛后，启转函数Adjust_Pull_Ommega() 中会加快、或减慢电磁场的转速Pull_Ommega，向永磁体垂直方向靠近, 同时返回磁铁垂直方向(Q轴)与当前电磁场的角度差Estimate_Q_Position - Angle_q，做为调整电流的依据。

为什么 T1+T2 > Pwm_Duty_Uplimit 时，就要等比例减小T1,T2 呢， 这个上限本应该是 PWM 周期，为何可以比 PWM 周期小呢？
  
当 T1 + T2 = PWM 周期时，输出电压达到最大，电压向量就是下图中、最大的那个边长为（VDD*2/3）的六边形，这种情况，上管导通的占空比很大，下管导通时间很短。双电阻测电流方式，因不能轮换测电流相，可能会在某个时刻测不到电流，或因下管导通时间太短，测到的电流误差太大，影响角度估算。


在红蓝相输出电压最大时，红蓝相下管导通时间几乎=0。


如果 SVPWM 计算时，限制 T1+T2 最大= PWM*0.8，则输出电压向量的六边形大小，就减小到80%，限制了下管导通的时间 >= 20%.  这样在下管导通时测电流的时间就很宽裕了，当然，这样最大输出电压也低了一些。

Vd_out_f17, Vq_out_f17 是电流 PI 计算出来的，有可能它俩的模大于母线电压，再计算 SVPWM 时，就会出现 T1+T2 > PWM 周期的情况。这时会修正 T1+T2 = PWM 周期，输出电压就比 Vd_out_f17, Vq_out_f17 小了，这时若用Vd_out_f17, Vq_out_f17做位置估算，比实际输出电压值大，位置估算数值就出错了。

因此 SVPWM 若 T1+T2 > PWM 周期，就要修正 Vd_out_f17 = Vd_out_f17 * PWM 周期/(T1+T2),  Vq_out_f17 =  Vq_out_f17 * PWM 周期/(T1+T2)，如此 Vq/Vd 又等于实际输出电压了。

代码如下
在做 SVPWM 时，I_beta，I_alpha  二者已赋值去掉15位小数的电压值Vq_out_f17, Vd_out_f17,  Section 的低16位是未修正的 T1+T2
432, 433行，把电压修正后，再恢复小数位，赋值给Vq_out_f17，Vd_out_f17


此处修正用的不是PWM 周期，而是 Pwm_Duty_Uplimit，因为这个值是计算 SVPWM 的上限，T1+T2 大于这个值，就会修正到这个值。

PWM  频率 15KHz 以上，用五段式 SVPWM, 可降低功率管开关次数，减小功率管发热量。
若 PWM 频率较低，10KHz 以下，就用七段式 SVPWM ,可降低 PWM 频率开关噪音，因为电流通断频率是 PWM 频率的两倍。

函数 M4_SVPWM() 是按五段式计算出的、三对PWM 的不供电时间。在本例中，就是PWM 低电平时间，是两边低电平时间和。把三个指针返回值，除2后写入占空比寄存器即可。

如果要用七段式，低电平最短的那路PWM, 低电平时间 temp16 要减半，另两相低电平时间，也减去 temp16/2

返回值 Section 的低16位，是 T1+T2,  即最大导通相的高电平时间。所以 temp16 = PWM周期 - Section 就是：低电平时间最短那相的、低电平时间。
五段式变七段式，只要三个指针返回值，都再减 temp16/2 就可以了,代码如下。


返回值 Section 低16位是 T1+T2 未修正值，如果它超过周期值了，就不必减了。

此代码起转方式，是 I/F 起动，还是V/F 起动？

这两种起动方式可以在代码中选配，由宏定义 __DO_CURRENT_PI_WHILE_ACTIVE  配置。

若选配了起动过程中做电流PI，就是I/F 起动，起动时，在状态2给自举电容充电后，变状态5磁体先吸到某个位置（这里耗费较长时间），再变状态4控制起转过程。整个过程电流是受控制的，对保护控制器比较有利。


若未定义__DO_CURRENT_PI_WHILE_ACTIVE ，就是起动过程不做电流PI控制, 起动时，在状态2给自举电容充电后，变状态3控制起转过程，起动过程稍快，但不做电流控制，电流波动较大。所以起动电压不要太大，防止电流冲太高对功率管不利

停转时一定关功率管吗？ 停转后可以去状态0关功率管，也可去状态5 保持小电流锁定状态。这个由宏定义 MOTOR_STOP_STATUS 配置。

转速的设置有个上限RPM_Set_Max、下限RPM_Set_Min, 还有个停转值 RPM_Stop_Value，停转值一般取负值，因为负值比0值更能让电流PI运算的结果——电流设定值——下降更快，电机停转也就更快。

状态1输出0电压，六个管子都输出PWM，七段式上下管交替导通50%，五段式下三管常通，都会刹车。
状态2输出0电压，但只下三管输出PWM, 上三管保持关断，七段式SVPWM下管只导通50% 时间，所以不会刹车，又可以给自举电容充电。main()开头，外设初始化时，进状态2 等50ms，就是给自举电容充电 50ms（RPM_Set 初值= RPM_Stop_Value -1）。

起转前，先进入状态2，给自举电容充电，充电时间到后，检测转速设定值RPM_Set，代码见下面截图：
1> 若转速设定值RPM_Set 比停转值RPM_Stop_Value 还小，就是给自举电容充电后功率管保持关断，去状态0 （201行）。
2> 若转速设定值RPM_Set 大于停转值RPM_Stop_Value，但小于0（204行）,  执行完状态2 就是保持停转状态。由MOTOR_STOP_STATUS 配置是停在状态0、还是跳转去状态5保持小电流锁定。




状态5锁定后，检测转速设定值 RPM_Set 是否大于0（328行），转速设定值大于0才起转，否则保持锁定状态，代码截图如下：

M451  可做 FOC + PFC 方案。 也可做 FOC + CAN通信 方案

七段式SVPWM 算法，一个PWM 周期有两次电流注入，所以电流频率是PWM 频率的两倍，PWM 频率若用10KHz（周期是 100us），电流频率主要是20KHz，所以噪音已比较小。

此M451 FOC 方案，PWM(ADC)中断耗时20us左右，所以另一组PWM  完全有时间做 PFC 控制。

我们推荐以下引脚配置， 同时留出CAN 通信引脚。PA2,PA3 可控制大功率 PFC 的主管和副管。

游客 223.104.219.x 发表于 2022-10-29 20:00
谢谢！再请教一下，Angle_q是不是开环时候假定的转子Q轴角度，同步以后就是观测器算出来的真实转子Q轴角度 ...

是的。
另一角度看，Angle_q 总是是坐标旋转的角度。起转时软件控制角度，同步时用估算的角度。

谢谢！再请教一下，Angle_q是不是开环时候假定的转子Q轴角度，同步以后就是观测器算出来的真实转子Q轴角度？