基于STM32F103的智能循迹绕障小车,利用红外循迹、超声波避障,实现当小车遇到障碍物时绕开障碍物后能回到轨道上继续循迹

时间: 2024-02-12 14:03:28 浏览: 30
好的,下面是一个基于STM32F103的智能循迹绕障小车的核心代码,供您参考: ``` #include "stm32f10x.h" #define IR_FL GPIO_Pin_0 #define IR_L GPIO_Pin_1 #define IR_BL GPIO_Pin_2 #define IR_FR GPIO_Pin_3 #define IR_R GPIO_Pin_4 #define IR_BR GPIO_Pin_5 #define TRIG GPIO_Pin_8 #define ECHO GPIO_Pin_9 void delay_us(uint32_t n) { uint32_t i; for(i = 0; i < n; i++); } void delay_ms(uint32_t n) { uint32_t i, j; for(i = 0; i < n; i++) for(j = 0; j < 1000; j++); } void GPIO_Configuration(void) { GPIO_InitTypeDef GPIO_InitStructure; RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE); GPIO_InitStructure.GPIO_Pin = IR_FL | IR_L | IR_BL | IR_FR | IR_R | IR_BR; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPD; GPIO_Init(GPIOB, &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = TRIG; GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; GPIO_Init(GPIOA, &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = ECHO; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPD; GPIO_Init(GPIOA, &GPIO_InitStructure); } void Forward(void) { // 控制小车轮子向前运动 } void Backward(void) { // 控制小车轮子向后运动 } void Left(void) { // 控制小车轮子向左运动 } void Right(void) { // 控制小车轮子向右运动 } void Stop(void) { // 控制小车轮子停止运动 } void AvoidObstacle(void) { // 超声波避障 GPIO_SetBits(GPIOA, TRIG); delay_us(10); GPIO_ResetBits(GPIOA, TRIG); while(GPIO_ReadInputDataBit(GPIOA, ECHO) == 0); uint32_t t1 = SysTick->VAL; while(GPIO_ReadInputDataBit(GPIOA, ECHO) == 1); uint32_t t2 = SysTick->VAL; uint32_t t = (t1 - t2) / SystemCoreClock * 1000000 / 58; if(t < 30) // 如果遇到障碍物 { Stop(); // 先停车 // 往右转一定角度,确保能绕开障碍物 Right(); delay_ms(500); // 开始绕障 while(1) { // 读取红外线传感器的信号 int ir_fl = GPIO_ReadInputDataBit(GPIOB, IR_FL); int ir_l = GPIO_ReadInputDataBit(GPIOB, IR_L); int ir_bl = GPIO_ReadInputDataBit(GPIOB, IR_BL); int ir_fr = GPIO_ReadInputDataBit(GPIOB, IR_FR); int ir_r = GPIO_ReadInputDataBit(GPIOB, IR_R); int ir_br = GPIO_ReadInputDataBit(GPIOB, IR_BR); // 如果已经绕过障碍物 if(ir_fl == 1 && ir_l == 1 && ir_bl == 1 && ir_fr == 1 && ir_r == 1 && ir_br == 1) { // 往左转一定角度,确保能回到轨道上 Left(); delay_ms(500); break; } // 如果前方有障碍物,继续绕障 if(ir_fl == 0 || ir_l == 0 || ir_bl == 0) Right(); else if(ir_fr == 0 || ir_r == 0 || ir_br == 0) Left(); else Forward(); } } } int main(void) { GPIO_Configuration(); while(1) { // 读取红外线传感器的信号 int ir_fl = GPIO_ReadInputDataBit(GPIOB, IR_FL); int ir_l = GPIO_ReadInputDataBit(GPIOB, IR_L); int ir_bl = GPIO_ReadInputDataBit(GPIOB, IR_BL); int ir_fr = GPIO_ReadInputDataBit(GPIOB, IR_FR); int ir_r = GPIO_ReadInputDataBit(GPIOB, IR_R); int ir_br = GPIO_ReadInputDataBit(GPIOB, IR_BR); // 判断小车行驶的方向 if(ir_l == 0 && ir_bl == 0) Right(); else if(ir_r == 0 && ir_br == 0) Left(); else if(ir_fl == 1 && ir_l == 1 && ir_bl == 1 && ir_fr == 1 && ir_r == 1 && ir_br == 1) Forward(); else AvoidObstacle(); } } ``` 以上代码仅供参考,具体实现需要根据具体的硬件和应用场景进行适当的修改和调整。

相关推荐

最新推荐

recommend-type

STM32实现智能小车电磁循迹

大学项目 用32单片机编写程序 通过铜制感应线圈对电流的磁通量测量,获取道路信息
recommend-type

基于STM32的循迹往返小车设计

智能车辆作为智能交通系统的关键技术之一,是许多高新技术综合集成的载体。它体现了车辆工程、人工...本文提出了一个基于STM32F103芯片为控制核心,附以红外传感器采集外界信息和检测障碍物的智能小车系统设计方案。
recommend-type

基于89C52单片机的智能循迹测速避障小车

基于89C52单片机的智能循迹测速避障小车,采用L293D作为电机驱动芯片
recommend-type

用STC12C5A60S2的智能循迹小车

本设计中的智能循迹小车,采用 TRCT5000 红外传感器为循迹模块,单片机 STC12C5A60S2 为控制模块,L298N 为电机驱动模块,LM2940 为电源模块。
recommend-type

zigbee-cluster-library-specification

最新的zigbee-cluster-library-specification说明文档。
recommend-type

管理建模和仿真的文件

管理Boualem Benatallah引用此版本:布阿利姆·贝纳塔拉。管理建模和仿真。约瑟夫-傅立叶大学-格勒诺布尔第一大学,1996年。法语。NNT:电话:00345357HAL ID:电话:00345357https://theses.hal.science/tel-003453572008年12月9日提交HAL是一个多学科的开放存取档案馆,用于存放和传播科学研究论文,无论它们是否被公开。论文可以来自法国或国外的教学和研究机构,也可以来自公共或私人研究中心。L’archive ouverte pluridisciplinaire
recommend-type

实现实时数据湖架构:Kafka与Hive集成

![实现实时数据湖架构:Kafka与Hive集成](https://img-blog.csdnimg.cn/img_convert/10eb2e6972b3b6086286fc64c0b3ee41.jpeg) # 1. 实时数据湖架构概述** 实时数据湖是一种现代数据管理架构,它允许企业以低延迟的方式收集、存储和处理大量数据。与传统数据仓库不同,实时数据湖不依赖于预先定义的模式,而是采用灵活的架构,可以处理各种数据类型和格式。这种架构为企业提供了以下优势: - **实时洞察:**实时数据湖允许企业访问最新的数据,从而做出更明智的决策。 - **数据民主化:**实时数据湖使各种利益相关者都可
recommend-type

解释minorization-maximization (MM) algorithm,并给出matlab代码编写的例子

Minorization-maximization (MM) algorithm是一种常用的优化算法,用于求解非凸问题或含有约束的优化问题。该算法的基本思想是通过构造一个凸下界函数来逼近原问题,然后通过求解凸下界函数的最优解来逼近原问题的最优解。具体步骤如下: 1. 初始化参数 $\theta_0$,设 $k=0$; 2. 构造一个凸下界函数 $Q(\theta|\theta_k)$,使其满足 $Q(\theta_k|\theta_k)=f(\theta_k)$; 3. 求解 $Q(\theta|\theta_k)$ 的最优值 $\theta_{k+1}=\arg\min_\theta Q(
recommend-type

JSBSim Reference Manual

JSBSim参考手册,其中包含JSBSim简介,JSBSim配置文件xml的编写语法,编程手册以及一些应用实例等。其中有部分内容还没有写完,估计有生之年很难看到完整版了,但是内容还是很有参考价值的。
recommend-type

"互动学习:行动中的多样性与论文攻读经历"

多样性她- 事实上SCI NCES你的时间表ECOLEDO C Tora SC和NCESPOUR l’Ingén学习互动,互动学习以行动为中心的强化学习学会互动,互动学习,以行动为中心的强化学习计算机科学博士论文于2021年9月28日在Villeneuve d'Asq公开支持马修·瑟林评审团主席法布里斯·勒菲弗尔阿维尼翁大学教授论文指导奥利维尔·皮耶昆谷歌研究教授:智囊团论文联合主任菲利普·普雷教授,大学。里尔/CRISTAL/因里亚报告员奥利维耶·西格德索邦大学报告员卢多维奇·德诺耶教授,Facebook /索邦大学审查员越南圣迈IMT Atlantic高级讲师邀请弗洛里安·斯特鲁布博士,Deepmind对于那些及时看到自己错误的人...3谢谢你首先,我要感谢我的两位博士生导师Olivier和Philippe。奥利维尔,"站在巨人的肩膀上"这句话对你来说完全有意义了。从科学上讲,你知道在这篇论文的(许多)错误中,你是我可以依