/* ******************************************************************************************************** 文件名：bsp_timer.c 功 能： 备 注：timer3 电机控制pwm,用到了timer3的ch3和ch4，即 PB0-PB1连接电机驱动的使能端PWMA（左电机）和 PWMB（右电机） timer1 用于系统100ms定时功能 timer2 用于左电机编码器计数 timer4 用于右电机编码器计数 ********************************************************************************************************* */ #include "bsp_timer.h" //***************************定时器3初始化 给电机提供PWM***************************// // TIM_Period / Auto Reload Register(ARR) = 1000 TIM_Prescaler--71 //arr：自动重装寄存器，psc分频系数 //PWM的频率 = 72MHz/ARR/PCS 例如 20K = 72M/3600/1 = 20K //=====初始化PWM 20KHZ 高频可以防止电机低频时的尖叫声 // ARR= 3599 时频率为20Khz //PB0控制PWMA--right moto，PB1控制PWMB--left moto。STBY直接拉高 //arr：自动重装寄存器，psc分频系数 //PWM的频率 = 72MHz/ARR/PCS 例如 20K = 72M/3600/1 = 20K void MOTO_PWM_Init(u32 arr, int psc) { TIM_OCInitTypeDef TIM_OCInitSructure; GPIO_InitTypeDef GPIO_InitStructure; TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); TIM_TimeBaseStructure.TIM_Period = arr-1; //自动重新装载寄存器周期的值澹ㄥ计数值澹) TIM_TimeBaseStructure.TIM_Prescaler = psc; //时钟分频系数 TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1; //对外部时钟进行采样的时钟分频 TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //向上计数 TIM_TimeBaseInit(TIM3,&TIM_TimeBaseStructure); //参数初始化 TIM_ClearFlag(TIM3, TIM_FLAG_Update); TIM_ITConfig(TIM3, TIM_IT_Update, ENABLE); //配置pwm输出端口 RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE); GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0| GPIO_Pin_1; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP; // 复用推挽输出 GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(GPIOB, &GPIO_InitStructure); //设置通道3 pwm参数 TIM_OCInitSructure.TIM_OCMode = TIM_OCMode_PWM1; TIM_OCInitSructure.TIM_OutputState= TIM_OutputState_Enable; TIM_OCInitSructure.TIM_Pulse = 0;//占空比= 50/100 TIM_OCInitSructure.TIM_OCPolarity = TIM_OCPolarity_High;//当定时器计数值小于CCR1_Val时为高电平 TIM_OC3Init(TIM3, &TIM_OCInitSructure);//参数初始化 TIM_OC3PolarityConfig(TIM3, TIM_OCPreload_Enable);//开始输出pwm //设置通道4 pwm参数 TIM_OCInitSructure.TIM_OCMode = TIM_OCMode_PWM1; TIM_OCInitSructure.TIM_OutputState= TIM_OutputState_Enable; TIM_OCInitSructure.TIM_Pulse = 0;//占空比= 50/100 TIM_OCInitSructure.TIM_OCPolarity = TIM_OCPolarity_High;//当定时器计数值小于CCR1_Val时为高电平 TIM_OC4Init(TIM3, &TIM_OCInitSructure);//参数初始化 TIM_OC4PolarityConfig(TIM3, TIM_OCPreload_Enable);//开始输出pwm TIM_ARRPreloadConfig(TIM3, ENABLE);//启动自动重装 TIM_Cmd(TIM3, ENABLE);//启动定时 } //占空比 = TIMx_CCRx / TIMx_ARR //moto_r：右轮电机，moto_l：左轮电机. 数值 0-100 void MOTO_PWM_Out(u16 moto_l, u16 moto_r) { TIM_OCInitTypeDef TIM_OCInitSructure; TIM_OCInitSructure.TIM_OCMode = TIM_OCMode_PWM1; TIM_OCInitSructure.TIM_OutputState= TIM_OutputState_Enable; //CH3 Left Motor TIM_OCInitSructure.TIM_Pulse = moto_l;//占空比= ccr/100 TIM_OC3Init(TIM3, &TIM_OCInitSructure);//参数初始化 TIM_OC3PolarityConfig(TIM3, TIM_OCPreload_Enable);//开始输出pwm //CH4 Right Motor TIM_OCInitSructure.TIM_Pulse = moto_r;//占空比= ccr /100 TIM_OC4Init(TIM3, &TIM_OCInitSructure);//参数初始化 TIM_OC4PolarityConfig(TIM3, TIM_OCPreload_Enable);//开始输出pwm TIM_ARRPreloadConfig(TIM3, ENABLE);//启动自动重装 } //***************************定时器1初始化 系统每10ms处理一次中断，更新数据，更新pwm等***************************// void Timer6_Init(void) { TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; NVIC_InitTypeDef NVIC_InitStructure; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM6, ENABLE); TIM_TimeBaseStructure.TIM_Period = 9999;//自动重新装载寄存器周期的值澹ㄥ计数值澹) TIM_TimeBaseStructure.TIM_Prescaler = 719;//时钟分频系数 TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1;//对外部时钟进行采样的时钟分频 TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;//向上计数 TIM_TimeBaseStructure.TIM_RepetitionCounter=0; //高级定时器1是用定时器功能配置这个才可以是正常的计数频率一开始的72mhz 值得注意的地方 TIM_TimeBaseInit(TIM6,&TIM_TimeBaseStructure);//参数初始化 TIM_ClearFlag(TIM6, TIM_FLAG_Update); TIM_ITConfig(TIM6, TIM_IT_Update, ENABLE); NVIC_PriorityGroupConfig(NVIC_PriorityGroup_4); NVIC_InitStructure.NVIC_IRQChannel=TIM6_IRQn; NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=5; NVIC_InitStructure.NVIC_IRQChannelSubPriority=0; NVIC_InitStructure.NVIC_IRQChannelCmd=ENABLE; NVIC_Init(&NVIC_InitStructure); TIM_Cmd(TIM6, ENABLE);//启动定时器 } //***************************定时器2初始化 ，使用编码器功能***************************// //左电机编码器计数 //PA0----接 编码器A相 或者电机驱动的B2B标识 //PA1----接 编码器B相 或者电机驱动的B2A标识 void Encoder_Init_TIM2(void) { TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; TIM_ICInitTypeDef TIM_ICInitStructure; GPIO_InitTypeDef GPIO_InitStructure; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);//使能定时器4的时钟 RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE);//使能PB端口时钟 GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0|GPIO_Pin_1; //端口配置 GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING; //浮空输入 GPIO_Init(GPIOA, &GPIO_InitStructure); //根据设定参数初始化GPIOB TIM_TimeBaseStructInit(&TIM_TimeBaseStructure); TIM_TimeBaseStructure.TIM_Prescaler = 0x0; // 预分频器 TIM_TimeBaseStructure.TIM_Period = ENCODER_TIM_PERIOD; //设定计数器自动重装值 TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1;//选择时钟分频：不分频 TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;////TIM向上计数 TIM_TimeBaseInit(TIM2, &TIM_TimeBaseStructure); TIM_EncoderInterfaceConfig(TIM2, TIM_EncoderMode_TI12, TIM_ICPolarity_Rising, TIM_ICPolarity_Rising);//使用编码器模式3 TIM_ICStructInit(&TIM_ICInitStructure); TIM_ICInitStructure.TIM_ICFilter = 10; TIM_ICInit(TIM2, &TIM_ICInitStructure); TIM_ClearFlag(TIM2, TIM_FLAG_Update);//清除TIM的更新标志位 TIM_ITConfig(TIM2, TIM_IT_Update, ENABLE); //Reset counter TIM_SetCounter(TIM2,0); TIM_Cmd(TIM2, ENABLE); } //***************************定时器4初始化 ，使用编码器功能***************************// //右电机编码器计数 //PB6----接 编码器B相 或者电机驱动的B1A标识 //PB7----接 编码器A相 或者电机驱动的B1B标识 void Encoder_Init_TIM4(void) { TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; TIM_ICInitTypeDef TIM_ICInitStructure; GPIO_InitTypeDef GPIO_InitStructure; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4, ENABLE);//使能定时器4的时钟 RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE);//使能PB端口时钟 GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6|GPIO_Pin_7; //端口配置 GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING; //浮空输入 GPIO_Init(GPIOB, &GPIO_InitStructure); //根据设定参数初始化GPIOB TIM_TimeBaseStructInit(&TIM_TimeBaseStructure); TIM_TimeBaseStructure.TIM_Prescaler = 0x0; // 预分频器 TIM_TimeBaseStructure.TIM_Period = ENCODER_TIM_PERIOD; //设定计数器自动重装值 TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1;//选择时钟分频：不分频 TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;////TIM向上计数 TIM_TimeBaseInit(TIM4, &TIM_TimeBaseStructure); TIM_EncoderInterfaceConfig(TIM4, TIM_EncoderMode_TI12, TIM_ICPolarity_Rising, TIM_ICPolarity_Rising);//使用编码器模式3 TIM_ICStructInit(&TIM_ICInitStructure); TIM_ICInitStructure.TIM_ICFilter = 10; TIM_ICInit(TIM4, &TIM_ICInitStructure); TIM_ClearFlag(TIM4, TIM_FLAG_Update);//清除TIM的更新标志位 TIM_ITConfig(TIM4, TIM_IT_Update, ENABLE); //Reset counter TIM_SetCounter(TIM4,0); TIM_Cmd(TIM4, ENABLE); } /************************************************************************** 函数功能：单位时间读取编码器计数 入口参数：定时器 返回 值：速度值 **************************************************************************/ int Read_Encoder(u8 TIMX) { int Encoder_TIM; switch(TIMX) { case 2: Encoder_TIM= (short)TIM2 -> CNT; TIM2 -> CNT=30000;break; case 3: Encoder_TIM= (short)TIM3 -> CNT; TIM3 -> CNT=30000;break; case 4: Encoder_TIM= (short)TIM4 -> CNT; TIM4 -> CNT=30000;break; default: Encoder_TIM=0; } return Encoder_TIM; } /************************************************************************** 函数功能：TIM4中断服务函数 入口参数：无 返回 值：无 **************************************************************************/ void TIM4_IRQHandler(void) { if(TIM4->SR&0X0001)//溢出中断 { } TIM4->SR&=~(1<<0);//清除中断标志位 } /************************************************************************** 函数功能：TIM2中断服务函数 入口参数：无 返回 值：无 **************************************************************************/ void TIM2_IRQHandler(void) { if(TIM2->SR&0X0001)//溢出中断 { } TIM2->SR&=~(1<<0);//清除中断标志位 }