自己看ST的FOC库时，添加了一些代码注释，可以辅助理解代码

将4kHz的浮点计算代码优化成了12kHz的定点计算代码，运行周期在80us以内，能够稳定运行。定点化的基本思路是将浮点数先放大一定的倍乘系数，并转换成32位整型的定点数，进行定点乘除法，再将结果还原回去，从而大大节省计算时间。倍乘系数一般取2的次方数，这样在还原的时候只需使用右移位即可代替除法操作进行倍除，从而节省一定的时间。定点化的难点在于，你不知道哪个变量该放大多少倍，太小会损失计算精度，太大会导致数据溢出，一般需要进行事先合理的评估以及实际上电试验。函数的定点化最好按先后顺序来，每转换完一步就验证一遍，确保万无一失。一般程序无法正常运行基本都是数据溢出导致的，这时需将倍乘系数调小一点。一些常量的计算不必放在循环里浪费计算资源，可以在初始化过程就先计算出来。另外，一些系数可以结合在一起，如ADC采样的电压需要乘以一个电流系数，这个电流系数就可以和PID参数合并（相乘），同样在初始化时就可以计算确定下来，省去多次乘法运算的步骤。定点化后，PID的控制量的目标输入量也需要根据你的设计进行调整，扩大相应的倍数。SVPWM的输出也可以直接设计成PWM比较值的范围，而不是占空比的形式。

参考simpleFOC代码，在stm32G431上实现了20kHz的FOC电流环。为了降低驱动器成本，将主控由G431改为F030，目前所有代码均为浮点计算，实现了4kHz的电流环（FOC单周期时间成本约230us），控制效果一般，可作为初步参考。后续需要改为定点计算，提高电流环频率以优化控制效果。。程序架构采用了ST电机库的方案，在ADC采样完成中断里执行FOC程序。驱动方式为3个EN端加TIM1三通道PWM输出，TIM3采集编码器AB相输入，3通道ADC扫描采样三相电桥低边通道采样电阻电压。TIM1为中心对齐模式1，PWM模式2，RCR设为1（每两次溢出触发一次中断，即在下溢时触发ADC采样）。上电后电机开环运行，校对Z相（外部上升沿中断）信号，确定编码器初始偏移量，调试时将变量start_run修改为1以开始执行闭环程序。电流环程序放在ADC采样完成回调函数里面，首先获取编码器计数值并计算电角度，然后获取电流采样值并经过clarke变换和park变换得到qd电流，再经低通滤波和PID计算后得到qd电压控制量，然后逆park变换并计算SVPWM占空，最后经TIM1输出三相占空。

M0单片机，无感FOC控制，顺逆风启动，已量产代码

峰岹6861实现压缩机控制

本文介绍了InstaSPIN-FOC™和InstaSPIN-MOTION™的用户指南。这些技术是用于控制电机的高级控制算法，可以提高电机的效率和性能。本文提供了详细的说明和使用指南，以帮助用户了解和使用这些技术。本文的最新修订日期为2021年10月。

高阶统计量对高斯噪声不敏感，可以解决色噪声背景下的相干信号源DOA估计问题。

TMCC160是德国TRINAMIC公司开发的全球首款片载系统集成了MCU和FOC算法支持CANOPEN和EtherCAT通讯

PLL 类估算器 本应用笔记中使用的估算器就是 AN1162 《交流感应电 机 （ACIM）的无传感器磁场定向控制 （FOC） 》（见 “ 参考文献 ”）中采用的估算器，只是在本文中用于 PMSM 电机而已。 估算器采用 PLL 结构。其工作原理基于反电动势 （BEMF）的 d 分量在稳态运行模式中必须等于零。图 6 给出了估算器的框图。 如图 6 中的闭环控制回路所示，对转子的估算转速 （ω Restim）进行积分，以获取估算角度，如公式 1 所示： 将 BEMF 的 q 分量除以电压常量 ΚΦ 得到估算转速 ω Restim，如公式 2 所示： 考虑公式 2 中给出的最初估算假设（BEMF 的 d 轴值在 稳态下为零），根据 BEMF q 轴值 Edf 的符号，使用 BEMF d 轴值 Edf 对 BEMF q 轴值 Edf 进行校正。经过公 式 3 显示的 Park 变换后，使用一阶滤波器对 BEMF d-q 分量值进行滤波。 采用固定的定子坐标系，公式 4 代表定子电路公式。 在公式 4 中，包含 α – β 的项通过经 Clarke 变换的三相 系统的对应测量值得到。以 Y 型（星型）连接的定子相 为例， LS 和 RS 分别代表每个相的定子电感和电阻。若 电机采用 Δ 连接， 则应计算等效的 Y 型连接相电阻和电 感，并在上述公式中使用。 图 7 表示估算器的参考电路模型。电机的 A、 B 和 C 端 连接到逆变器的输出端。电压 VA、 VB 和 VC 代表施加 给电机定子绕组的相电压。 VAB、 VBC 和 VCA 代表逆变 器桥臂间的线电压，相电流为 IA、 IB 和 IC。

TI C2000 MCU 电机控制应用的完整软件库 InstaSPIN-FOC：无传感器 FOC 解决方案 DesignDRIVE：有传感器 FOC 解决方案