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

停转时一定关功率管吗？ 停转后可以去状态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轴角度？

下载代码后，不做改动，电感最大可到100mH，电阻最大可到500欧。
如果电感再大，可把电感除10后再赋值给Ld/Lq，然后把单位常量Unit_Magnify 也除10就可以。
目前我测试过的电机，电感最大的是220V的电机：50220/49220uH；电感最小的是航模电调用的一个小电机：11/9uH。

十分感谢楼主解答，顺便请教一下这个代码有没有试过比较大的电感和电阻电机，如果一般冰箱压缩机的电阻有几欧姆到十几欧姆，电感几十到一百多mH，油烟机的风机电感和电阻也很大，惯量也大，可以试试效果。

电流的基准是ADC 的值。一般电流ADC 数值较小，换算后会损失精度，所以不换算。ADC中断里，读出电流ADC 值乘 8 后再坐标旋转，求得 dq 轴电流赋给 Id_Measure_f3 ，Iq_Measure_f3 ，此处后缀 _f3，表示有 3 位小数。
在做电流PI 运算前，对直流量 Iq_Measure_f3 又做了一次滤波，并增加了一位小数赋值给 Iq_Meas_LPF_f4, 后缀 _f4 表示有 4位小数。

电压的基准值是 0.1V。最大值是 16383，若超过此值, 乘4后大于等于65536做坐标旋转会溢出，即最大工作电压是 1638.3V。 在ADC中断里, 读出母线电压ADC值，就换计算出0.1V 的数值，然后赋给变量 V_BUS_0v1

具体代码如下：  母线电压，电路上是俩220K 串4K1电阻分压后到ADC 引脚，所以分压比 (220*2+4.1)/4.1,  12位ADC 参考电压是5V,  所以  ADC值换算成电压公式是：
电压 =   5V * ADC值 / 4096  再乘分压比(444.1/4.1)， 这个公式右边再乘10 就是0.1V数值，简化后 = ADC值*5416/4096 。代码中 355 行, 加1024是四舍五入，右移 11位是除 2048，少除了2后面补上。

把当前电压 ADC 值看作 X，
459行是求出了 2X。
460行是 2X + 2Y,  这是母线电压的4倍, 成了 25mV 的数值,  用25mV数值去做 SVPWM计算,  哪怕工作电压不到10V,也有足够的计算精度。最大电压 1638.3V 的数据乘4后得65532, 坐标变换也不会溢出。
461行是 (2X + 2Y)/4 = (X+Y)/2， 这是一阶低通滤波 Y(n) = [Y(n-1) + X(n)]/2。


SVPWM 能输出的无失真相电压，最大值是 0.577倍的母线电压，再大, 就是削顶的正弦电压了。 227行，选择一个相电压上限值。增加17位小数后，赋值给 Vq_Limit_f17，Vd_Limit_f17 (后缀 _f17 表示17位小数) 用于电流PI 运算结果的上限值。  电流PI 运算结果有17位小数,  电压上限在这里先增加17 小数，比在PI 运算结果限幅时再增加17位小数，节省代码。

请楼主再给讲解一下变量标幺值，看不懂

这里讲一下 Clark 变换

求 I_alpha, I_beta,  就是求电流向量的实部和虚部。A相在0度，B相在120度，C相在-120度，三个电流写成复数形式分别为


求三个电流的“失量和” 。 三相电流的“标量和=0“，即Ia+Ib+Ic = 0，这个不用求。


因为在下MOS 导通时测电流，显然下MOS导通时间长时,电流ADC 受PWM 开关影响就小，值相对准确一些。
如果 C 相下 MOS 导通时间短、就用 Ia 和 Ib 计算电流向量， Ic = -Ia-Ib 代入向量求和公式，得到

消去 Ia 或 Ib 的公式，请读者自己推导

等幅变换中电流向量若是 I,  则对应相电流峰值是 I*2/3。所以上式求出的电流向量，乘2/3后才与控制量对应,  这样公式就变成了

上式这个电流向量的模，正好与相电流的峰值，数值上相等。
下面来看代码，
126~136行，按扇区,选择下MOS导通时间长的两相, 求I_alpha, I_beta，为了减小计算误差先增加小数，数值乘8
138行，1/3 的开方=0.57735 =18919/32768, 所以乘18919再右移15位就是乘1/3的开方，右移小了3位，等于是把结果乘了8


执行完138行后，就求出了 I_alpha，I_beta 。接下来坐标变换求出了有3位小数的 Id 和 Iq 电流