目录
前面
Speed_and_Position_Estimator
获取HALL信号
HALL状态更新
计算转速
位置判断
ADC相电流/总线电流电压
获取AD值
计算实际值
低速高速切换
SlowLoopControl
FastLoopControl
最后
前面
前面分析了BLDC的开环与闭环，接下来分析PMSM或者说FOC的算法框架。
MBD-有感(Hall)开环BLDC控制模型（上） · 语雀
MBD-有感(Hall)开环BLDC控制模型（下） · 语雀
MBD-有感(Hall)BLDC闭环控制模型 · 语雀
Speed_and_Position_Estimator
所在位置：
内部框架：
获取HALL信号
使用的是中断触发，而且还是双边沿触发。
HALL状态更新
其实就是触发一次中断，就反转变量HALL_A_Input
计算转速
这里采用的是下降沿检测霍尔信号，两个下降沿之间的时间对应的就是HALL信号的变化周期。
周期=计数值(TIME_CNT)*100us的定时器(C_LST)
频率=1/周期 单位是秒，这里得到的是 转/秒
转化成 转/分钟，需要*60：Vrpm=60/(TIME_CNT*C_LST)
最后实际转速，还要除以极对数pp：Vrpm=60/(TIME_CNT*C_LST/pp)
如下图1部分所示
rpm2rad/s公式：1 rpm = 1(r)/1(min) = 1(r)/60(s) = 2π (rad)/60(s) =π/30 (rad/s)
位置判断
这个就没啥好讲的，HALl值=A+2B+4C，分别对应不同的扇区。
ADC相电流/总线电流电压
FOC控制需要获取三相电流，这一步与电路图密切相关。
获取AD值
内部结构如下
这里有一个问题一直没搞懂，为什么ADC_IB是靠ADC1中断直接引出来的一个data？而不是像ADC_IA一样靠配置好通道然后读取一个值。
计算实际值
获取三相电流，这里是双电阻采样，由两相电流计算出三相电流，这里注意使用了多次浮点数相关的运算。
获取总线电流，总线电压。
低速高速切换
切换逻辑，其实搞得也不太明白，有些地方不懂
感觉像是通过一个计数器来计算。
SlowLoopControl
低速环主要任务如下：
在Generate_Speed_Reference模块中：
在Compute_Positioning_Mode模块中：
在Speed_Controller模块中：
FastLoopControl
在模块里：
很常见的FOC算法模型，坐标变换，PI调节，输出PWM。
放几个比较有意思的点
电流环DQ轴PI控制器：
PWM输出模块：
计算电角度模块ComputeElectricAngle：
输入转速rad/s，经过计算(2*pi/60)*PP*Nmax*(C_LST/2/pi)*(2^31)，可以得到电角度。
最后
转的很好
