基于STM32芯片的四驱循迹小车

2024-03-19 1827阅读

温馨提示:这篇文章已超过371天没有更新,请注意相关的内容是否还可用!

循迹小车包括三个基本模块:

1.宏定义模块

2.电机驱动模块

3.红外循迹模块

4.PWM调速模块

基于STM32芯片的四驱循迹小车

我将代码部分分为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();       
}

二、电机模块

基于STM32芯片的四驱循迹小车

这是商家给的原理图,理念是两个电机驱动模块控制四个电机,也就是一个电机驱动模块控制两个电机。所以在电机模块我们要做的就是初始化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  0)
    {
        if(speed_count  
 

.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口保持高电平

基于STM32芯片的四驱循迹小车

.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对应端口的图片,并用杜邦线将对应的端口连接起来

基于STM32芯片的四驱循迹小车

基于STM32芯片的四驱循迹小车基于STM32芯片的四驱循迹小车

总结

本文记录的是基于stm32c8t6芯片的循迹小车,属于我的学习分享,如果有不正确的地方欢迎大家指出,并且我将在循迹小车的功能上继续编写红外避障的功能,拓宽小车功能,大家一起共勉!

VPS购买请点击我

免责声明:我们致力于保护作者版权,注重分享,被刊用文章因无法核实真实出处,未能及时与作者取得联系,或有版权异议的,请联系管理员,我们会立即处理! 部分文章是来自自研大数据AI进行生成,内容摘自(百度百科,百度知道,头条百科,中国民法典,刑法,牛津词典,新华词典,汉语词典,国家院校,科普平台)等数据,内容仅供学习参考,不准确地方联系删除处理! 图片声明:本站部分配图来自人工智能系统AI生成,觅知网授权图片,PxHere摄影无版权图库和百度,360,搜狗等多加搜索引擎自动关键词搜索配图,如有侵权的图片,请第一时间联系我们,邮箱:ciyunidc@ciyunshuju.com。本站只作为美观性配图使用,无任何非法侵犯第三方意图,一切解释权归图片著作权方,本站不承担任何责任。如有恶意碰瓷者,必当奉陪到底严惩不贷!

目录[+]