用stm32实现五路循迹模块的功能,控制小车循迹的代码

时间: 2023-06-16 12:05:36 浏览: 1479
循迹模块一般使用红外线传感器,可以检测黑线和白线的反差,从而实现对小车行驶方向的控制。以下是使用STM32实现五路循迹的代码示例: ```c #include "stm32f10x.h" #define Trig1 GPIO_Pin_0 #define Echo1 GPIO_Pin_1 #define Trig2 GPIO_Pin_2 #define Echo2 GPIO_Pin_3 #define Trig3 GPIO_Pin_4 #define Echo3 GPIO_Pin_5 #define Trig4 GPIO_Pin_6 #define Echo4 GPIO_Pin_7 #define Trig5 GPIO_Pin_8 #define Echo5 GPIO_Pin_9 void delay_us(u32 n) { u32 i; while(n--) { i = 10; while(i--); } } void Ultrasonic_Init(void) { GPIO_InitTypeDef GPIO_InitStructure; TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure; TIM_ICInitTypeDef TIM_ICInitStructure; NVIC_InitTypeDef NVIC_InitStructure; RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB | RCC_APB2Periph_AFIO, ENABLE); RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); GPIO_InitStructure.GPIO_Pin = Trig1 | Trig2 | Trig3 | Trig4 | Trig5; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(GPIOA, &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = Echo1 | Echo2 | Echo3 | Echo4 | Echo5; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU; GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(GPIOB, &GPIO_InitStructure); TIM_TimeBaseInitStructure.TIM_Period = 0xFFFF; TIM_TimeBaseInitStructure.TIM_Prescaler = 72 - 1; TIM_TimeBaseInitStructure.TIM_ClockDivision = 0; TIM_TimeBaseInitStructure.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIM3, &TIM_TimeBaseInitStructure); TIM_ICInitStructure.TIM_Channel = TIM_Channel_1; TIM_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_Rising; TIM_ICInitStructure.TIM_ICSelection = TIM_ICSelection_DirectTI; TIM_ICInitStructure.TIM_ICPrescaler = TIM_ICPSC_DIV1; TIM_ICInitStructure.TIM_ICFilter = 0; TIM_ICInit(TIM3, &TIM_ICInitStructure); TIM_ICInitStructure.TIM_Channel = TIM_Channel_2; TIM_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_Falling; TIM_ICInitStructure.TIM_ICSelection = TIM_ICSelection_IndirectTI; TIM_ICInitStructure.TIM_ICPrescaler = TIM_ICPSC_DIV1; TIM_ICInitStructure.TIM_ICFilter = 0; TIM_ICInit(TIM3, &TIM_ICInitStructure); TIM_ITConfig(TIM3, TIM_IT_CC1 | TIM_IT_CC2, ENABLE); TIM_Cmd(TIM3, ENABLE); NVIC_InitStructure.NVIC_IRQChannel = TIM3_IRQn; NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0; NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; NVIC_Init(&NVIC_InitStructure); } void Ultrasonic_Trigger(u16 GPIO_Pin) { GPIO_SetBits(GPIOA, GPIO_Pin); delay_us(10); GPIO_ResetBits(GPIOA, GPIO_Pin); } u16 Ultrasonic_GetDistance(u16 GPIO_Pin) { u16 distance = 0; u32 counter = 0; TIM3->CNT = 0; Ultrasonic_Trigger(GPIO_Pin); while(GPIO_ReadInputDataBit(GPIOB, GPIO_Pin) == RESET); TIM_Cmd(TIM3, ENABLE); while(GPIO_ReadInputDataBit(GPIOB, GPIO_Pin) == SET) { counter++; if(counter > 60000) break; } TIM_Cmd(TIM3, DISABLE); distance = (float)counter / 58.0; return distance; } int main(void) { u16 distance[5]; Ultrasonic_Init(); while(1) { distance[0] = Ultrasonic_GetDistance(Echo1); distance[1] = Ultrasonic_GetDistance(Echo2); distance[2] = Ultrasonic_GetDistance(Echo3); distance[3] = Ultrasonic_GetDistance(Echo4); distance[4] = Ultrasonic_GetDistance(Echo5); if(distance[0] > 10 && distance[0] < 30) //左前 { //向右转 } else if(distance[1] > 10 && distance[1] < 30) //左 { //向右转 } else if(distance[2] > 10 && distance[2] < 30) //中 { //直行 } else if(distance[3] > 10 && distance[3] < 30) //右 { //向左转 } else if(distance[4] > 10 && distance[4] < 30) //右前 { //向左转 } else //没有检测到黑线 { //停止 } } } ``` 以上代码中,使用了定时器TIM3作为超声波模块的计时器,通过捕获定时器的计数值来计算超声波的回波时间,并进而计算出距离。通过检测五路超声波模块返回的距离来判断小车的行驶方向,从而实现对小车的控制。
阅读全文

相关推荐

最新推荐

recommend-type

STM32实现智能小车电磁循迹

【STM32实现智能小车电磁循迹】项目旨在利用STM32单片机和电磁感应原理,构建一个能够沿着预设线路自主行驶的智能小车。该项目涉及到多个技术环节,包括赛道检测原理、电感线圈设计、信号处理电路、传感模块功能实现...
recommend-type

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

STM32F103芯片为核心的智能循迹小车设计是一种常见的电子竞赛项目,它集成了微控制器技术、传感器技术、电机控制以及显示技术等多种领域知识。STM32系列是意法半导体(STMicroelectronics)推出的基于ARM Cortex-M...
recommend-type

伺服驱动器调试雷赛摆轮参数设置.docx

伺服驱动器调试雷赛摆轮参数设置.docx 伺服驱动器调试软件设置原点及定位值: 1、 调试需要1根雷赛调试电缆以及1根USB转RS232串口线; 2、 打开雷赛只能高压伺服调试软件,选择USB端口号,点连接,如下图所示:
recommend-type

海风小店,商城,微信小开源程序商城管理后台,后台管理,VUE.zip

不用 Electron,直接web的,用这个链接https://github.com/iamdarcy/hioshop-admin-web海风小店,商城(后台管理端开源VUE)基于开源项目NideShop重建,开源了一些功能的同时完善了一些功能,并重新设计了UI数据测试来自上述开源项目服务端api基于Node.js+ThinkJS+MySQL后台管理基于VUE.js+element-ui基于海风小店开发上线的小程序视频教程https://www.bilibili.com/video/av89568075该项目综合微信小程序https://github.com/iamdarcy/hioshop-miniprogram服务端https://github.com/iamdarcy/hioshop-server网页版管理后台https://github.com/iamdarcy/hioshop-管理网线上演示https://demo.qilelab.com/hioshop用户名qilelab.com密码qilelab.com 阿里云主机低至2折立即去
recommend-type

基于 redux 的轻量级小程序状态管理框架,适配原生小程序,wepy,taro.zip

维普克斯 升级方案wepyx -> weappx@1.xweappx@1.x -> 2.x如果有好的建议欢迎 issue 讨论 安装开发环境支持安装 npm 依赖的话,直接使用命令安装即可npm install weappx原生小程序开发可以通过拷贝 git 项目中 packages/xxx/dist 中的 bundle 文件到实际项目中进行引用框架接入DEMOcount(weapp原生小程序)计数(wepy)todoMVC(wepy)计数(weapp-开始)芋头數特征上手简单,仅需要了解 4 个 api更易用的 action 派发方式更简单的数据处理copy-on-write独立存在的事件中心强大的 hook 机制链接指导API更新日志贡献执照和
recommend-type

Python中快速友好的MessagePack序列化库msgspec

资源摘要信息:"msgspec是一个针对Python语言的高效且用户友好的MessagePack序列化库。MessagePack是一种快速的二进制序列化格式,它旨在将结构化数据序列化成二进制格式,这样可以比JSON等文本格式更快且更小。msgspec库充分利用了Python的类型提示(type hints),它支持直接从Python类定义中生成序列化和反序列化的模式。对于开发者来说,这意味着使用msgspec时,可以减少手动编码序列化逻辑的工作量,同时保持代码的清晰和易于维护。 msgspec支持Python 3.8及以上版本,能够处理Python原生类型(如int、float、str和bool)以及更复杂的数据结构,如字典、列表、元组和用户定义的类。它还能处理可选字段和默认值,这在很多场景中都非常有用,尤其是当消息格式可能会随着时间发生变化时。 在msgspec中,开发者可以通过定义类来描述数据结构,并通过类继承自`msgspec.Struct`来实现。这样,类的属性就可以直接映射到消息的字段。在序列化时,对象会被转换为MessagePack格式的字节序列;在反序列化时,字节序列可以被转换回原始对象。除了基本的序列化和反序列化,msgspec还支持运行时消息验证,即可以在反序列化时检查消息是否符合预定义的模式。 msgspec的另一个重要特性是它能够处理空集合。例如,上面的例子中`User`类有一个名为`groups`的属性,它的默认值是一个空列表。这种能力意味着开发者不需要为集合中的每个字段编写额外的逻辑,以处理集合为空的情况。 msgspec的使用非常简单直观。例如,创建一个`User`对象并序列化它的代码片段显示了如何定义一个用户类,实例化该类,并将实例序列化为MessagePack格式。这种简洁性是msgspec库的一个主要优势,它减少了代码的复杂性,同时提供了高性能的序列化能力。 msgspec的设计哲学强调了性能和易用性的平衡。它利用了Python的类型提示来简化模式定义和验证的复杂性,同时提供了优化的内部实现来确保快速的序列化和反序列化过程。这种设计使得msgspec非常适合于那些需要高效、类型安全的消息处理的场景,比如网络通信、数据存储以及服务之间的轻量级消息传递。 总的来说,msgspec为Python开发者提供了一个强大的工具集,用于处理高性能的序列化和反序列化任务,特别是当涉及到复杂的对象和结构时。通过利用类型提示和用户定义的模式,msgspec能够简化代码并提高开发效率,同时通过运行时验证确保了数据的正确性。"
recommend-type

管理建模和仿真的文件

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

STM32 HAL库函数手册精读:最佳实践与案例分析

![STM32 HAL库函数手册精读:最佳实践与案例分析](https://khuenguyencreator.com/wp-content/uploads/2020/07/bai11.jpg) 参考资源链接:[STM32CubeMX与STM32HAL库开发者指南](https://wenku.csdn.net/doc/6401ab9dcce7214c316e8df8?spm=1055.2635.3001.10343) # 1. STM32与HAL库概述 ## 1.1 STM32与HAL库的初识 STM32是一系列广泛使用的ARM Cortex-M微控制器,以其高性能、低功耗、丰富的外设接
recommend-type

如何利用FineReport提供的预览模式来优化报表设计,并确保最终用户获得最佳的交互体验?

针对FineReport预览模式的应用,这本《2020 FCRA报表工程师考试题库与答案详解》详细解读了不同预览模式的使用方法和场景,对于优化报表设计尤为关键。首先,设计报表时,建议利用FineReport的分页预览模式来检查报表的布局和排版是否准确,因为分页预览可以模拟报表在打印时的页面效果。其次,通过填报预览模式,可以帮助开发者验证用户交互和数据收集的准确性,这对于填报类型报表尤为重要。数据分析预览模式则适合于数据可视化报表,可以在这个模式下调整数据展示效果和交互设计,确保数据的易读性和分析的准确性。表单预览模式则更多关注于表单的逻辑和用户体验,可以用于检查表单的流程是否合理,以及数据录入
recommend-type

大学生社团管理系统设计与实现

资源摘要信息:"基于ssm+vue的大学生社团管理系统.zip" 该系统是基于Java语言开发的,使用了ssm框架和vue前端框架,主要面向大学生社团进行管理和运营,具备了丰富的功能和良好的用户体验。 首先,ssm框架是Spring、SpringMVC和MyBatis三个框架的整合,其中Spring是一个全面的企业级框架,可以处理企业的业务逻辑,实现对象的依赖注入和事务管理。SpringMVC是基于Servlet API的MVC框架,可以分离视图和模型,简化Web开发。MyBatis是一个支持定制化SQL、存储过程以及高级映射的持久层框架。 SpringBoot是一种全新的构建和部署应用程序的方式,通过使用SpringBoot,可以简化Spring应用的初始搭建以及开发过程。它使用了特定的方式来进行配置,从而使开发人员不再需要定义样板化的配置。 Vue.js是一个用于创建用户界面的渐进式JavaScript框架,它的核心库只关注视图层,易于上手,同时它的生态系统也十分丰富,提供了大量的工具和库。 系统主要功能包括社团信息管理、社团活动管理、社团成员管理、社团财务管理等。社团信息管理可以查看和编辑社团的基本信息,如社团名称、社团简介等;社团活动管理可以查看和编辑社团的活动信息,如活动时间、活动地点等;社团成员管理可以查看和编辑社团成员的信息,如成员姓名、成员角色等;社团财务管理可以查看和编辑社团的财务信息,如收入、支出等。 此外,该系统还可以通过微信小程序进行访问,微信小程序是一种不需要下载安装即可使用的应用,它实现了应用“触手可及”的梦想,用户扫一扫或者搜一下即可打开应用。同时,它也实现了应用“用完即走”的理念,用户不用关心是否安装太多应用的问题。应用将无处不在,随时可用,但又无需安装卸载。 总的来说,基于ssm+vue的大学生社团管理系统是一款功能丰富、操作简便、使用方便的社团管理工具,非常适合大学生社团的日常管理和运营。