基于STM32芯片的四驱循迹小车 |
您所在的位置：网站首页 › RS3四驱原理 › 基于STM32芯片的四驱循迹小车 |
基于STM32芯片的四驱循迹小车
|
循迹小车包括三个基本模块： 1.宏定义模块 2.电机驱动模块 3.红外循迹模块 4.PWM调速模块 
我将代码部分分为4个模块进行模块化编程：interface(各个引脚口的宏定义，方便记忆)、motor(电机驱动模块)、timer(定时器模块)、track(红外循迹模块) 一、宏定义模块.h 各个引脚的宏定义以及实现小车前进后退的引脚使能函数定义(22-40行) #ifndef __INTERFACE_H_ #define __INTERFACE_H_ #include "stm32f10x.h" #include "motor.h" #include "track.h" #include "timer.h" #include "speedset.h" #define SEARCH_L_PIN GPIO_Pin_2 #define SEARCH_L_GPIO GPIOA #define SEARCH_L_IO GPIO_ReadInputDataBit(SEARCH_L_GPIO, SEARCH_L_PIN) #define SEARCH_R_PIN GPIO_Pin_3 #define SEARCH_R_GPIO GPIOA #define SEARCH_R_IO GPIO_ReadInputDataBit(SEARCH_R_GPIO, SEARCH_R_PIN) #define BLACK_AREA 1 #define WHITE_AREA 0 #define FRONT_LEFT_F_PIN GPIO_Pin_7 #define FRONT_LEFT_F_GPIO GPIOA #define FRONT_LEFT_F_SET GPIO_SetBits(FRONT_LEFT_F_GPIO , FRONT_LEFT_F_PIN) #define FRONT_LEFT_F_RESET GPIO_ResetBits(FRONT_LEFT_F_GPIO , FRONT_LEFT_F_PIN) #define FRONT_LEFT_B_PIN GPIO_Pin_6 #define FRONT_LEFT_B_GPIO GPIOA #define FRONT_LEFT_B_SET GPIO_SetBits(FRONT_LEFT_B_GPIO , FRONT_LEFT_B_PIN) #define FRONT_LEFT_B_RESET GPIO_ResetBits(FRONT_LEFT_B_GPIO , FRONT_LEFT_B_PIN) #define FRONT_RIGHT_F_PIN GPIO_Pin_4 #define FRONT_RIGHT_F_GPIO GPIOA #define FRONT_RIGHT_F_SET GPIO_SetBits(FRONT_RIGHT_F_GPIO , FRONT_RIGHT_F_PIN) #define FRONT_RIGHT_F_RESET GPIO_ResetBits(FRONT_RIGHT_F_GPIO , FRONT_RIGHT_F_PIN) #define FRONT_RIGHT_B_PIN GPIO_Pin_5 #define FRONT_RIGHT_B_GPIO GPIOA #define FRONT_RIGHT_B_SET GPIO_SetBits(FRONT_RIGHT_B_GPIO , FRONT_RIGHT_B_PIN) #define FRONT_RIGHT_B_RESET GPIO_ResetBits(FRONT_RIGHT_B_GPIO , FRONT_RIGHT_B_PIN) #define FRONT_LEFT_GO FRONT_LEFT_F_SET; FRONT_LEFT_B_RESET #define FRONT_LEFT_BACK FRONT_LEFT_F_RESET; FRONT_LEFT_B_SET #define FRONT_LEFT_STOP FRONT_LEFT_F_RESET; FRONT_LEFT_B_RESET #define FRONT_RIGHT_GO FRONT_RIGHT_F_SET; FRONT_RIGHT_B_RESET #define FRONT_RIGHT_BACK FRONT_RIGHT_F_RESET;FRONT_RIGHT_B_SET #define FRONT_RIGHT_STOP FRONT_RIGHT_F_RESET;FRONT_RIGHT_B_RESET void GPIOCLK_Init(void); void all_init(void); #endif.c 使能时钟和各模块的总初始化 #include "interface.h" void GPIOCLK_Init(void) { RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA , ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB , ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC , ENABLE); } void all_init(void) { GPIOCLK_Init(); motor_init(); tracking_init(); TIM2_Init(); } 二、电机模块
这是商家给的原理图，理念是两个电机驱动模块控制四个电机，也就是一个电机驱动模块控制两个电机。所以在电机模块我们要做的就是初始化PA4 PA5 PA6 PA7，再编写小车的前后左右移动函数。因为是四驱车，所以小车的转向是通过两边车轮反向运动实现的。 .c 下面内容中的个别变量(speed_count、Time_10us_motor、front_left_speed_duty、front_left_speed_duty)与定时器有关将在下一模块讲解 #include "motor.h" #include "stm32f10x.h" #include "speedset.h" unsigned int speed_count=0; unsigned char Time_10us_motor = 0; int front_left_speed_duty=0; int front_right_speed_duty=0; void MotorGPIO_Configuration(void) { GPIO_InitTypeDef GPIO_InitStructure; GPIO_InitStructure.GPIO_Pin = FRONT_LEFT_F_PIN; GPIO_InitStructure.GPIO_Speed = GPIO_Speed_2MHz; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; GPIO_Init(FRONT_LEFT_F_GPIO, &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = FRONT_LEFT_B_PIN; GPIO_Init(FRONT_LEFT_B_GPIO, &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = FRONT_RIGHT_F_PIN; GPIO_Init(FRONT_RIGHT_F_GPIO, &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = FRONT_RIGHT_B_PIN; GPIO_Init(FRONT_RIGHT_B_GPIO, &GPIO_InitStructure); } void CarMove(void) { if(front_left_speed_duty > 0) { if(speed_count < front_left_speed_duty) { FRONT_LEFT_GO; }else { FRONT_LEFT_STOP; } } else if(front_left_speed_duty < 0) { if(speed_count < (-1)*front_left_speed_duty) { FRONT_LEFT_BACK; }else { FRONT_LEFT_STOP; } } else { FRONT_LEFT_STOP; } if(front_right_speed_duty > 0) { if(speed_count < front_right_speed_duty) { FRONT_RIGHT_GO; }else { FRONT_RIGHT_STOP; } } else if(front_right_speed_duty < 0) { if(speed_count < (-1)*front_right_speed_duty) { FRONT_RIGHT_BACK; }else { FRONT_RIGHT_STOP; } } else { FRONT_RIGHT_STOP; } } void CarGo(void) { front_left_speed_duty= sudu; front_right_speed_duty=sudu; } void CarBack(void) { front_left_speed_duty=-sudu; front_right_speed_duty=-sudu; } void CarLeft(void) { front_left_speed_duty=sudu; front_right_speed_duty=-sudu-10; } void CarRight(void) { front_left_speed_duty=-sudu-10; front_right_speed_duty=sudu; } void CarStop(void) { front_left_speed_duty=0; front_right_speed_duty=0; } void CarBack_Trailing(void) { front_left_speed_duty=-sudu; front_right_speed_duty=-sudu; } void CarLeft_Trailing(void) { front_left_speed_duty=90; front_right_speed_duty=-90; } void CarRight_Trailing(void) { front_left_speed_duty=-90; front_right_speed_duty=90; } void motor_init(void) { MotorGPIO_Configuration(); CarStop(); }.h #ifndef __MOTOR_H_ #define __MOTOR_H_ #include "interface.h" extern int front_left_speed_duty; extern int front_right_speed_duty; extern unsigned char Time_10us_motor; extern unsigned int speed_count; void motor_init(void); void CarMove(void); void CarGo(void); void CarBack(void); void CarLeft(void); void CarRight(void); void CarStop(void); void motor_init(void); void CarBack_Trailing(void); void CarLeft_Trailing(void); void CarRight_Trailing(void); #endif 三、定时器模块循迹小车在控制速度方面一般使用的是PWM定时器，通过调节占空比来调节小车的转速，寻常的有通过硬件来实现此功能，即改变CCR和ARR的值来改变固定周期内高电平的时间来调节占空比，吸收了店家的参考代码，这次我通过软件来实现占空比的改变,通过定时器中断不断实现变量自加来设置周期。 他是这样想的，周期设置为100份(下文简称100)，我让小车前30向前，后70停止，就是占空比30% 实现途径就是一个一个计数：0，1，2，...，直到30以前都让小车向前，一旦数到31，那么就让小车停止。 因为定时器中断中的speed_count在不断改变，而小车的运动与否是由speed_count与xxxx_xxx_speed_duty的大小关系决定的，所以通过改变xxxx_xxx_speed_duty的大小就可以改变小车运动时间的大小也就是常说的占空比，而上面的程序里也写了xxxx_xxx_speed_duty的大小=sudu，所以我们最终改变sudu这个变量的大小就能改变占空比也就能改变小车的速度 #include "timer.h" unsigned char Time_10us_sum = 0; unsigned char Time_1ms = 0; static void NVIC_TIM2Configuration(void)//中断初始化 { NVIC_InitTypeDef NVIC_InitStructure; NVIC_InitStructure.NVIC_IRQChannel = TIM2_IRQn; NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0; NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1; NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; NVIC_Init(&NVIC_InitStructure); } void TIM2_Init(void)//定时器初始化 { TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE); TIM_TimeBaseStructure.TIM_Period = (10- 1); TIM_TimeBaseStructure.TIM_Prescaler = (72 - 1); TIM_TimeBaseStructure.TIM_ClockDivision = 0; TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIM2, &TIM_TimeBaseStructure); TIM_ClearITPendingBit(TIM2, TIM_IT_Update); TIM_ITConfig(TIM2, TIM_IT_Update, ENABLE); TIM_Cmd(TIM2, ENABLE); NVIC_TIM2Configuration(); } void TIM2_IRQHandler(void)//定时器执行函数 { if (TIM_GetITStatus(TIM2, TIM_IT_Update) != RESET) { TIM_ClearITPendingBit(TIM2, TIM_IT_Update); Time_10us_sum++; Time_10us_motor++; //变量自加 if(Time_10us_sum >= 100)//1ms { Time_10us_sum = 0; Time_1ms++; } if(Time_10us_motor >= 10)//0.1ms { Time_10us_motor = 0; speed_count++; if(speed_count >= 100) { speed_count = 0; } CarMove(); } } } 四、红外循迹模块实现小车循迹需要用到两个红外循迹模块，在循迹模块被黑线遮挡时，对应引脚电平发生变化，通过读取引脚电平来判断是否要转弯(转弯时一边会先接触黑线，如果没接触黑线就直行)，因为赛道转弯变化多端，所以在循迹方面的代码设置上加入了sudu这一个变量来调速，sudu大小可以在实际调试中改变，同时循迹模块的灵敏度也可以调节，通过改变小车的速度和循迹模块的灵敏度可以让小车在赛道上更稳定的运行。 注意：这里的GPIO输出模式设置为上拉输入，让小车在没有检测到黑线时IO口保持高电平 
.c #include "track.h" void tracking_init(void)// 引脚初始化 { GPIO_InitTypeDef GPIO_InitStructure; GPIO_InitStructure.GPIO_Pin = SEARCH_R_PIN; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU; GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(SEARCH_R_GPIO , &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = SEARCH_L_PIN; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU; GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(SEARCH_L_GPIO , &GPIO_InitStructure); } void tracking_detector() //循迹函数 { if(SEARCH_L_IO == WHITE_AREA && SEARCH_R_IO == WHITE_AREA) { CarGo(); } if(SEARCH_L_IO == BLACK_AREA&&SEARCH_R_IO == WHITE_AREA) { CarLeft_Trailing(); } if (SEARCH_R_IO == BLACK_AREA&&SEARCH_L_IO == WHITE_AREA) { CarRight_Trailing(); } if (SEARCH_R_IO == BLACK_AREA&&SEARCH_L_IO == BLACK_AREA) { CarStop(); } } void tracking_display_execute(void) { sudu=22; //循迹平稳运行速度（可调，但速度快了红外灵敏度可能跟不上） tracking_detector(); }.h #ifndef __TRACK_H_ #define __TRACK_H_ #include "interface.h" void tracking_detector(void); void tracking_init(void); void tracking_display_execute(void); #endif最后，在main.c进行所有模块的初始化，再一直执行tracking_display_execute()函数就可以实现循迹的功能。 #include "interface.h" int main(void) { all_init(); while(1){ tracking_display_execute(); } } 五、困难与解决因为是第一次进行stm32项目，难免遇到小问题，我将把个人遇到的问题与解决方法向大家分享。 keil的使用keil软件是一款不断更新的软件，我的电脑因为重装(不要使用中文用户名！！！)后下载的是最新版本的keil，在编译后出现了几个莫名的报错，这个问题在不断尝试后通过使用更低版本的keil得到了解决，新版本的keil可能因为刚出版与部分代码不兼容，建议大家先使用稳定下来的老版本。 St-link的使用我的stilink是在买正点原子学习板的时候一起买的，而stlink的接口与我的核心板的接口不一样，这个时候就需要向你的客服索要stilink对应端口的图片，并用杜邦线将对应的端口连接起来 
总结
本文记录的是基于stm32c8t6芯片的循迹小车，属于我的学习分享，如果有不正确的地方欢迎大家指出，并且我将在循迹小车的功能上继续编写红外避障的功能，拓宽小车功能，大家一起共勉！ |
【本文地址】