TB6612 是双驱动,可以驱动两个电机
驱动 1 路
PWMA 接单片机的 PWM 口
真值表:
AIN1 0 0 1
AIN2 0 1 0停止 正传 反转
A01
AO2 接电机 1 的两个脚
驱动 2 路
PWMB 接单片机的 PWM 口
真值表:
BIN1 0 0 1
BIN2 0 1 0停止 正传 反转
B01
BO2 接电机 2 的两个脚
其中当 STBY 口接单片机的 IO 口清零电机全部停止
1.根据原理图寻找对应的IO引脚
2.根据引脚在芯片手册查找(PWMA,B引脚)对应的 (定时器与定时器通道).
3.开启IO口相应的时钟,和定时器时钟
4.配置定时器初始化: TIM_TimeBaseInit()
5.配置相应的通道: TIM_OC3Init() /TIM_OC4Init
6.使能CRR预装载通道寄存器
7.使能ARR预重装载通道寄存器
8.使能定时器9.设置占空比(传参数值)
10.根据真值表对电机进行控制
11.传入正数或负数的参数,对电机进行真反转控制
void motor_init() //AIN1-2,BIN1-2初始化
{GPIO_InitTypeDef GPIOInitDef;
//-------------------------------------------------------------------------------- RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB,ENABLE);
//--------------------------------------------------------------------------------GPIOInitDef.GPIO_Mode=GPIO_Mode_Out_PP;GPIOInitDef.GPIO_Pin=GPIO_Pin_12|GPIO_Pin_13|GPIO_Pin_14|GPIO_Pin_15;GPIOInitDef.GPIO_Speed=GPIO_Speed_50MHz;GPIO_Init(GPIOB,&GPIOInitDef);motor_pwm_init();
}void motor_pwm_init()
{GPIO_InitTypeDef GPIOInitDef;TIM_TimeBaseInitTypeDef TIMBaseInitDef;TIM_OCInitTypeDef TIMOCInitDef;
//-------------------------------------------------------------------------------- RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA,ENABLE);RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2,ENABLE);
//-------------------------------------------------------------------------------- GPIOInitDef.GPIO_Mode=GPIO_Mode_AF_PP; GPIOInitDef.GPIO_Pin=GPIO_Pin_2|GPIO_Pin_3;GPIOInitDef.GPIO_Speed=GPIO_Speed_50MHz;GPIO_Init(GPIOA,&GPIOInitDef); //PWMA,B引脚初始化TIMBaseInitDef.TIM_ClockDivision=TIM_CKD_DIV1; TIMBaseInitDef.TIM_CounterMode=TIM_CounterMode_Up; //向上计数TIMBaseInitDef.TIM_Period=100-1;TIMBaseInitDef.TIM_Prescaler=36-1;TIM_TimeBaseInit(TIM2,&TIMBaseInitDef); //定时器初始化TIMOCInitDef.TIM_OCMode=TIM_OCMode_PWM1; //输出模式为1TIMOCInitDef.TIM_OutputState=TIM_OutputState_Enable; //使能输出TIMOCInitDef.TIM_Pulse=0; //CRR寄存器的值,后面会改变TIMOCInitDef.TIM_OCPolarity=TIM_OCPolarity_High;TIM_OC3Init(TIM2,&TIMOCInitDef); //输出通道3配置TIMOCInitDef.TIM_OCMode=TIM_OCMode_PWM1; //输出模式为1TIMOCInitDef.TIM_OutputState=TIM_OutputState_Enable; //使能输出TIMOCInitDef.TIM_Pulse=0; //CRR寄存器的值,后面会改变TIMOCInitDef.TIM_OCPolarity=TIM_OCPolarity_High;TIM_OC4Init(TIM2,&TIMOCInitDef); //输出通道4配置
//--------------------------------------使能CRR预装载通道寄存器 TIM_OC3PreloadConfig(TIM2,TIM_OCPreload_Enable);TIM_OC4PreloadConfig(TIM2,TIM_OCPreload_Enable);
//--------------------------------------使能ARR预重装载通道寄存器TIM_ARRPreloadConfig(TIM2,ENABLE);TIM_Cmd(TIM2,ENABLE);//使能定时器2
}//占空比设置
void PWM_SetCompare3(int16_t Compare)
{TIM_SetCompare3(TIM2, Compare); //设置占空比
}void PWM_SetCompare4(int16_t Compare)
{TIM_SetCompare4(TIM2, Compare);
}//设置电机转动
/******** 设置电机转动 *****/
void Motor_SetSpeed(int8_t Speed) //设置电机转速,有符号量,正反转
{if (Speed >= 0){GPIO_SetBits(GPIOB, GPIO_Pin_14);GPIO_ResetBits(GPIOB, GPIO_Pin_15);PWM_SetCompare3(Speed); //将速度值传到占空比GPIO_SetBits(GPIOB, GPIO_Pin_13);GPIO_ResetBits(GPIOB, GPIO_Pin_12);PWM_SetCompare4(Speed);}else{GPIO_ResetBits(GPIOB, GPIO_Pin_14);GPIO_SetBits(GPIOB, GPIO_Pin_15);PWM_SetCompare3(-Speed); //将速度值传到占空比GPIO_ResetBits(GPIOB, GPIO_Pin_13);GPIO_SetBits(GPIOB, GPIO_Pin_12);PWM_SetCompare4(-Speed);}
}//设置控制正转反转
void motor_pull()
{if(USART_RX_STA&0x8000){if(USART_RX_BUF[0]=='q' && USART_RX_BUF[1]=='a'){Motor_SetSpeed(50);printf("正转");}if(USART_RX_BUF[0]=='q' && USART_RX_BUF[1]=='q'){Motor_SetSpeed(-50);printf("反转");}USART_RX_STA=0;memset(USART_RX_BUF,0,200);}delay_ms(1000);
}
本文发布于:2024-02-05 02:49:25,感谢您对本站的认可!
本文链接:https://www.4u4v.net/it/170722262462327.html
版权声明:本站内容均来自互联网,仅供演示用,请勿用于商业和其他非法用途。如果侵犯了您的权益请与我们联系,我们将在24小时内删除。
留言与评论(共有 0 条评论) |