FOC(笔记二)

时间:2025/7/14 8:40:09来源：https://blog.csdn.net/qq_50299271/article/details/140422038 浏览次数:0次

接上篇文章：FOC算法(笔记一)_马鞍波和三角波调制合成-CSDN博客

前面已经对FOC的开环控制进行了介绍，下面对FOC的闭环控制进行介绍。

本次使用的电机参数如下图所示：

一、HALL传感器

1.1、霍尔传感器的角度、速度计算

因为本次使用的是120°安装的三相霍尔编码器，所以霍尔德精度是非常低的，如下图所示的，每圈只能检测6次，对角度的精度是比较低的，所以较低速度情况下如无法获得电机的角度和角速度信息的。

所以通过计算上一个60°的电机的转速，作为下一个60°来临之前的速度，乘以ADC检测时间就可以算出中间检测时间。

（1）如下图所示的，通过判断霍尔三相GPIO的电平可以判断当前霍尔的角度在第几个60°。

（2）一般电机三相的0角度为Ud=1、Uq=0电平的时候转子所在位置，所以转子的0°和霍尔德0°，也即是如下图所示0x50位置所示的0°，两个是不一样的，所以需要对角度进行补偿，具体补偿如下代码所示：

#define PHASE_SHIFT_ANGLE (float)(220.0f/360.0f*2.0f*PI)

（3）只知道是多少个60°，精度太低，所以通过定时器对三相霍尔德编码器进行霍尔(HALL)模式的检测，当有上升沿、下降沿的时候就触发定时器的中断，之后通过中断的时间和60°角度计算出来电机的转速，后面在ADC检测中使用角度自增的时候，直接用速度乘以ADC检测时间就可以计算出来每次ADC检测角度的增量。从而平滑的获得角度递增的锯齿波结果。

（4）上面（3）中计算出来的速度是电机的角速度，在速度闭环控制的时候，使用的机械速度，并且两者都是弧度制的，所以应该将角速度转化为机械速度(转/min、r/min)：角速度(°/s)/360°/60s*极对数.

2.2、霍尔编码器嵌入式程序

如下面代码所示的是TIM4定时器的编码器模式，在检测到三相上有电平变化的时候产生中断，中断中调用下面的回调函数，回调函数中计算速度(机械角度频率，转/分钟，rmp/min)，ADC一个检测周期角度增加值。

（1）HallTemp = HAL_TIM_ReadCapturedValue(&htim4,TIM_CHANNEL_1);
（2）HallThetaAdd = (PI/3)/(HallTemp/3200000)/10000;
（3）HallSpeed = (PI/3)*2/(HallTemp/3200000)*60/(2*PI);

（1）获得触发定时器中断的时间。

（2）计算ADC一个检测周期的角度增加值HallThetaAdd，PI/3表示一个编码器触发周期的角度；HallTemp/3200000表示定时器的计时时间，单位秒，（计数次数/TIM时钟频率）；10000标志ADC检测的频率，除以频率等于乘以ADC检测一次时间。

（3）计算电机的速度(rmp/min)，2表示电机的极对数，将电角度转化为机械角度；60是将秒转化为分钟；(2*PI)标志一圈的弧度，将弧度转化为圈。

//转子0角度和霍尔零角度的差值补偿
#define PHASE_SHIFT_ANGLE (float)(220.0f/360.0f*2.0f*PI)void HAL_TIM_IC_CaptureCallback(TIM_HandleTypeDef *htim)
{/* Prevent unused argument(s) compilation warning */UNUSED(htim);if(htim == &htim4){HallTemp = HAL_TIM_ReadCapturedValue(&htim4,TIM_CHANNEL_1);HallThetaAdd = (PI/3)/(HallTemp/3200000)/10000;          //电角度的速度增量，除以10000是为了提前乘以ADC采样时间。HallSpeed = (PI/3)/(HallTemp/3200000)*30/(2*PI);         //角度的计算，60/计数时间，然后将电角度转化为机械角度//    /* 一介低通滤波器，对于高频噪声滤波效果好，运算量小 */
//    HallSpeed_filter = HallSpeed;
//    HallSpeed_filter = (1-(HallTemp/16000))*HallSpeed_last+(HallTemp/16000)*HallSpeed_filter;
//    HallSpeed_last = HallSpeed_filter;/* 角度的判断，只能60增加的判断 */HallReadTemp = HAL_GPIO_ReadPin(GPIOB,GPIO_PIN_8);HallReadTemp |= HAL_GPIO_ReadPin(GPIOB,GPIO_PIN_7)<<1;HallReadTemp |= HAL_GPIO_ReadPin(GPIOB,GPIO_PIN_6)<<2;if(HallReadTemp==0x05) {HallTheta = 0.0f+PHASE_SHIFT_ANGLE;}else if(HallReadTemp==0x04){HallTheta = (PI/3.0f)+PHASE_SHIFT_ANGLE;}else if(HallReadTemp==0x06){HallTheta = (PI*2.0f/3.0f)+PHASE_SHIFT_ANGLE;}else if(HallReadTemp==0x02){HallTheta = PI+PHASE_SHIFT_ANGLE;}else if(HallReadTemp==0x03){HallTheta = (PI*4.0f/3.0f)+PHASE_SHIFT_ANGLE;}else if(HallReadTemp==0x01){HallTheta = (PI*5.0f/3.0f)+PHASE_SHIFT_ANGLE;}if(HallTheta<0.0f){HallTheta += 2.0f*PI;}else if(HallTheta>(2.0f*PI)){HallTheta -= 2.0f*PI;}	}
}

下面是对上面回调函数中计算的数据的使用。

HallTheta = HallTheta + HallThetaAdd;    //区间角度+角度变化值
if(HallTheta < 0.0f)
{HallTheta += 2.0f*PI;
}
else if(HallTheta > (2.0f*PI))
{HallTheta -= 2.0f*PI;
}
g_SC.theta = HallTheta;           //当前的角度值
g_SpPI.Speed_now = HallSpeed;     //当前编码器速度