3.红外对管模块

我们的思路是通过将红外对管装到小车的车头,红外朝地面,当红外扫描到底下有黑色的时候就进行转向

当4个红外对管都没发现底下有黑色线的时候,小车就一直往前走

当最左1和左2单个或者左1&左2都识别到的时候,小车就往左转

当最右1和右2单个或者右1&右2都识别到的时候,小车就往右转

我们也可把红外模块当做按键,当下面是黑色的时候就是高电平,不是黑色的时候就是低电平,所以这里需要用到中断

查看原理图

红外对管分别对应PB5,PB4,PB3,PA15

接下来我们看手册能知道PB5,PB4,PB3,PA15这几个脚都是特殊脚

所以我们需要JTAG-DP 启用SW-DP ,我们重映射配置应写为

cpp 复制代码
GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable, ENABLE);

注意:不要关闭所有的烧录脚,不然会造成无法通过串口烧录等情况,只能通过usb口刷官方文件复位

我们可以使用GPIO_ReadInputDataBit这个函数来读取四个红外对管的电平状态,用作判断底下是否为黑线

相关宏定义

cpp 复制代码
#define HW_1 GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_5)//读取 PB5 
#define HW_2 GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_4)//读取 PB4
#define HW_3 GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_3)//读取 PB3
#define HW_4 GPIO_ReadInputDataBit(GPIOA,GPIO_Pin_15)//读取 PA15

GPIO初始化

cpp 复制代码
void Infrared_GPIO_Init(void)
{

RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB,ENABLE);//使能PORTA时钟
    
 
GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable, ENABLE);//需要关闭JTAG-DP 启用SW-DP才能使用3/4/5 IO口 
    
GPIO_InitTypeDef GPIO_InitStructure;
GPIO_InitStructure.GPIO_Pin  = GPIO_Pin_15;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPD; //PA0设置成输入,默认下拉      
GPIO_Init(GPIOA, &GPIO_InitStructure);

GPIO_InitStructure.GPIO_Pin  = GPIO_Pin_3 | GPIO_Pin_4 | GPIO_Pin_5;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPD; //PA0设置成输入,默认下拉      
GPIO_Init(GPIOB, &GPIO_InitStructure);
}

封装循迹函数

这里我们可以通过调节Delay时间来控制拐弯的力度,这个需要自己细心的慢慢调

cpp 复制代码
//通过调节Delay来控制拐弯的力度
void Infrared_Hw(void)
{

        //四个红外为低电平的时候向前走
        if(HW_1 ==0 && HW_2 ==0 && HW_3 ==0 && HW_4 ==0)
        {
            Forward();
            printf("1+2+3+4\n");
            OLED_ShowString(x,y,"Forward");
            Delay_ms(50);
        }
        //第二个红外为高电平的时候向右走
        if(HW_1 ==0 && HW_2 ==1 && HW_3 ==0 && HW_4 ==0)
        {
            Rightward();
            printf("2\n");
            OLED_ShowString(x,y,"Right2");
            Delay_ms(150);
        }
        //第一个红外为高电平的时候向右走
        if(HW_1 ==1 && HW_2 ==0 && HW_3 ==0 && HW_4 ==0)
        {
            Rightward();
            printf("1\n");
            Delay_ms(250);
        }
        
        //第一个红外和第二个红外同时为高电平的时候向右走
        if(HW_1 ==1 && HW_2 ==1 && HW_3 ==0 && HW_4 ==0)
        {
            Rightward();
            printf("1+2\n");
            Delay_ms(300);
        }
        //第三个红外为高电平的时候向左走  
        if(HW_1 ==0 && HW_2 ==0 && HW_3 ==1 && HW_4 ==0)
        {
            Leftward();
            printf("3\n");
            OLED_ShowString(x,y,"Left3");
            Delay_ms(150);
        }
        //第四个红外为高电平的时候向左走 
        if(HW_1 ==0 && HW_2 ==0 && HW_3 ==0 && HW_4 ==1)
        {
            Leftward();
            printf("4\n");
            OLED_ShowString(x,y,"Left4");
            Delay_ms(250);
        }
        //第三个红外和第四个红外同时为高电平的时候向左走 
        if(HW_1 ==0 && HW_2 ==0 && HW_3 ==1 && HW_4 ==1)
        {
            Leftward();
            printf("3+4\n");
            OLED_ShowString(x,y,"Left3+4");
            Delay_ms(300);
        }
    
}
相关推荐
廷华电子18 分钟前
STM32H743+AX58100学习板
stm32·嵌入式硬件·电机控制·ethercat·cia402
busideyang44 分钟前
函数指针类型定义笔记
c语言·笔记·stm32·单片机·算法·嵌入式
我的老子姓彭3 小时前
stm32串口hal库
stm32·单片机·嵌入式硬件
爱喝纯牛奶的柠檬3 小时前
【已验证】STM32F103的MPU6050应用一(驱动篇)
stm32·单片机·嵌入式硬件
是翔仔呐3 小时前
第10章 串口通信USART全解:轮询/中断/DMA三种收发模式与上位机通信实战
c语言·开发语言·stm32·单片机·嵌入式硬件·学习·gitee
17(无规则自律)3 小时前
深度剖析Linux Input子系统(1):宏观架构与核心原理
linux·嵌入式硬件
lingzhilab4 小时前
零知IDE——STM32驱动ICM20948九轴姿态角解算(上位机演示+数据导出)
stm32·单片机·嵌入式硬件
SUNNYSPY00112 小时前
65R135 -ASEMI超结MOS管TO-220封装
单片机
jacklood13 小时前
基于STM32的车载振动曲线摆件创意设计
stm32·单片机·嵌入式硬件
jomoly13 小时前
星闪NL002开发板测评+匆匆
单片机·嵌入式硬件