STM32 Cubemax(六) —— STM32利用定时器编码器模式处理带编码器直流电机
前言
电赛延期了,趁有时间再写点东西吧.
编码器电机配置较为繁琐,本文较长,耐心看下去,一定有收获.
本文适合已经对编码器有所了解的同学观看,如果对编码器原理还不太理解,可以看看CSDN中别人讲编码器的,个人觉得已经讲的十分清楚了,这里主要讲解怎么使用Cubemax去使用编码器
一、硬件准备
- 本次实验使用的是带增量式AB相霍尔编码器的直流减速电机
简单介绍一下这款电机,减速比为1:30,即输出轴转一圈,电机内部实际转30圈,霍尔编码器为13位编码器,即电机每转,对于编码器有2的13次方的增量.(简单的说,上面那个霍尔编码器检测的圆盘,转一圈,检测13个脉冲)
2. 电机所使用的电机驱动为应该大家都十分熟悉的L298N
这里就不过多介绍了,CSDN上也有很多对此介绍十分详细的.
3. 合适的8-12V的电源
电机额定电压为12V,可以选择串联3节锂电池12V,或者两节锂电池8V来进行实验.
二、接线 !!!
电机 | L298N | STM32 |
M- | OUT1 | / |
5V | 5V | / |
A | / | 编码器模式定时器IO |
B | / | 编码器模式定时器IO |
GND |
GND | GND |
M+ | OUT2 | / |
/ | ENA | PWM输出IO |
/ | M1 | 输出IO |
/ | M2 | 输出IO |
其中,这里要说明几点.
1.L298N,单片机和电机需要共地
2.我这里使用的是单PWM输出IO来控制ENA,而不是和其他博主一样使用两路PWM输出去控制M1,M2,然后一直使能的方法,这样可以节约一个定时器产生PWM.
三、Cubemax配置
1.首先是接线中用来控制M1和M2的两个IO口的输出配置,这里我使用的是PC4和PC5
2.开启定时器一的编码器模式
这里面修改Counter Period为20000,即代表,编码器计数器范围为0~20000.其他默认即可,这里的分配系数表示的对计数值分频,如果你这里写了3=4-1,那后面speed算的时候就不用除以4了。
对应的IO口为PE9,PE11.
3.开启用于控制ENA的PWM输出
这里采用的是定时器5的PWM输出.
本实验使用的是F103的板子,PWM输出频率为100hz
4.开启每隔10ms对编码器定时器中值的读取的定时器
5.最后配置中断
这里注意一下,最好编码器的更新中断定时器,要比10ms定时器的优先级高,可以防止在更新中打被打断.
四、代码
首先创建一个文件Motor.c和Motor.h,在此文件中来编写我们有关电机的代码.
首先在Motor.h中来定义一些我们常用的东西
1.Motor.h中定义Motor相关参数
#define RR 30u //电机减速比
#define RELOADVALUE __HAL_TIM_GetAutoreload(&htim1) //获取自动装载值,本例中为20000
#define COUNTERNUM __HAL_TIM_GetCounter(&htim1) //获取编码器定时器中的计数值
#define IN1(state) HAL_GPIO_WritePin(GPIOC,GPIO_PIN_4,(GPIO_PinState)(state)) //M1
#define IN2(state) HAL_GPIO_WritePin(GPIOC,GPIO_PIN_5,(GPIO_PinState)(state)) //M2
//电机结构体
typedef struct _Motor
{
int32_t lastAngle; //上10ms转过的角度
int32_t totalAngle; //总的角度
int16_t loopNum; //溢出次数计数值
float speed; //电机输出轴目前转速,单位为RPM
}Motor;
2.Motor初始化
void Motor_Init()
{
HAL_TIM_Encoder_Start(&htim1, TIM_CHANNEL_ALL); //开启编码器定时器
__HAL_TIM_ENABLE_IT(&htim1,TIM_IT_UPDATE); //开启编码器定时器更新中断,防溢出处理
HAL_TIM_Base_Start_IT(&htim6); //开启10ms定时器中断
HAL_TIM_PWM_Start(&htim5, TIM_CHANNEL_2); //开启PWM
__HAL_TIM_SET_COUNTER(&htim1, 10000); //编码器定时器初始值设定为10000
motor.loopNum = 0; //溢出计数
}
此函数在main中使用即可.
3.中断处理函数重写
我们需要重写HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim)来处理中断
void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim)
{
if(htim->Instance==htim6.Instance) //10ms中断
{
int16_t pluse = COUNTERNUM - RELOADVALUE/2;
//从开始到现在当前10ms的总脉冲数
motor.totalAngle = pluse + motor.loopNum * RELOADVALUE/2;
//进行速度计算,根据前文所说的,4倍频,编码器13位,减速比30,再乘以6000即为每分钟输出轴多少转
//motor.totalAngle - motor.lastAngle为当前10ms内的增量,即脉冲数
motor.speed = (float)(motor.totalAngle - motor.lastAngle)/(4*13*RR)*6000;
motor.lastAngle = motor.totalAngle; //更新转过的圈数
}
//如果是编码器更新中断,即10ms内,脉冲数超过了计数范围,需要进行处理
else if(htim->Instance == htim1.Instance)
{
if(COUNTERNUM < 10000) motor.loopNum++; //向上计数超过10000,正溢出+1
else if(COUNTERNUM > 10000) motor.loopNum--; //向下计数小于0,负溢出+1
__HAL_TIM_SetCounter(&htim1, 10000); //重新设定初始值
}
}
这里注意,本文采用了编码器更新中断的方法,防止出现10ms内出现电机转速过快,脉冲计数超过设定值的情况出现,跟其他博主不同,主流在编码器计数时都采用限定值为65535,并没有考虑这个情况,不过多数电机不是转太快的情景,主流的方法都可行.
之后我们可以通过,对IN1,IN2写值,来控制电机正转,反转,然后对PWM写值,来控制电机运动来观察结构体中Motor中speed值的变化.
如果懒的写,就用手去选择一下输出轴或者上面的编码器盘,在debug中观察一下现象.
总结
本文介绍了编码器电机数据的读取,当我们可以读取到编码器电机中的值后,我们就可以在后续进行PID速度和串级PID角度的控制.
STM32 Cubemax(七) —— 单级PID控制带编码器的直流减速电机速度
版权声明:本文为CSDN博主「lzzzzzzm」的原创文章,遵循CC 4.0 BY-SA版权协议,转载请附上原文出处链接及本声明。
原文链接:https://blog.csdn.net/lzzzzzzm/article/details/119416134
暂无评论