stm32循迹小车代码

时间: 2023-09-02 08:15:37 浏览: 24
循迹小车的代码可以分为以下几个部分: 1.引入头文件和定义全局变量 ``` #include "stm32f10x.h" #include "delay.h" #include "usart.h" #define IN1 GPIO_Pin_0 #define IN2 GPIO_Pin_1 #define IN3 GPIO_Pin_2 #define IN4 GPIO_Pin_3 #define ENA TIM1->CCR1 #define ENB TIM1->CCR2 uint16_t LeftSpeed = 0; uint16_t RightSpeed = 0; ``` 2.初始化函数 ``` void Init() { delay_init(); USART1_Init(9600); TIM1_PWM_Init(5000-1, 71); //PWM频率为5KHz TIM_SetCompare1(TIM1, 0); TIM_SetCompare2(TIM1, 0); GPIO_InitTypeDef GPIO_InitStructure; RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB, ENABLE); GPIO_InitStructure.GPIO_Pin = IN1 | IN2 | IN3 | IN4; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(GPIOA, &GPIO_InitStructure); } ``` 3.控制左右轮速度的函数 ``` void SetLeftSpeed(int16_t speed) { if(speed > 0) { GPIO_WriteBit(GPIOA, IN1, Bit_SET); GPIO_WriteBit(GPIOA, IN2, Bit_RESET); ENA = speed; } else if(speed < 0) { GPIO_WriteBit(GPIOA, IN1, Bit_RESET); GPIO_WriteBit(GPIOA, IN2, Bit_SET); ENA = -speed; } else { GPIO_WriteBit(GPIOA, IN1, Bit_RESET); GPIO_WriteBit(GPIOA, IN2, Bit_RESET); ENA = 0; } } void SetRightSpeed(int16_t speed) { if(speed > 0) { GPIO_WriteBit(GPIOA, IN3, Bit_RESET); GPIO_WriteBit(GPIOA, IN4, Bit_SET); ENB = speed; } else if(speed < 0) { GPIO_WriteBit(GPIOA, IN3, Bit_SET); GPIO_WriteBit(GPIOA, IN4, Bit_RESET); ENB = -speed; } else { GPIO_WriteBit(GPIOA, IN3, Bit_RESET); GPIO_WriteBit(GPIOA, IN4, Bit_RESET); ENB = 0; } } ``` 4.循迹函数 ``` void RunTrack() { uint16_t Left, Mid, Right; Left = GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_11); Mid = GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_10); Right = GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_1); if(Left == 1 && Mid == 0 && Right == 1) { SetLeftSpeed(1000); SetRightSpeed(1000); } else if(Left == 1 && Mid == 0 && Right == 0) { SetLeftSpeed(1000); SetRightSpeed(800); } else if(Left == 0 && Mid == 0 && Right == 1) { SetLeftSpeed(800); SetRightSpeed(1000); } else if(Left == 0 && Mid == 1 && Right == 0) { SetLeftSpeed(1000); SetRightSpeed(1000); } else if(Left == 1 && Mid == 1 && Right == 0) { SetLeftSpeed(1000); SetRightSpeed(800); } else if(Left == 0 && Mid == 1 && Right == 1) { SetLeftSpeed(800); SetRightSpeed(1000); } else { SetLeftSpeed(0); SetRightSpeed(0); } } ``` 5.主函数 ``` int main(void) { Init(); while (1) { RunTrack(); delay_ms(10); //控制循迹小车的循迹速度 } } ``` 以上就是循迹小车的代码,需要注意的是,具体的接线方式和传感器的编号可能会因为不同的循迹小车而有所不同,需要具体的参考相关的文档。

相关推荐

最新推荐

recommend-type

STM32实现智能小车电磁循迹

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

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

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

学习基于VUE的GIS.zip

"GIS" 通常指的是 地理信息系统(Geographic Information System)。它是一种特定的空间信息系统,用于捕获、存储、管理、分析、查询和显示与地理空间相关的数据。GIS 是一种多学科交叉的产物,涉及地理学、地图学、遥感技术、计算机科学等多个领域。 GIS 的主要特点和功能包括: 空间数据管理:GIS 能够存储和管理地理空间数据,这些数据可以是点、线、面等矢量数据,也可以是栅格数据(如卫星图像或航空照片)。 空间分析:GIS 提供了一系列的空间分析工具,用于查询、量测、叠加分析、缓冲区分析、网络分析等。 可视化:GIS 能够将地理空间数据以地图、图表等形式展示出来,帮助用户更直观地理解和分析数据。 数据输入与输出:GIS 支持多种数据格式的输入和输出,包括数字线划图(DLG)、数字高程模型(DEM)、数字栅格图(DRG)等。 决策支持:GIS 可以为城市规划、环境监测、灾害管理、交通规划等领域提供决策支持。 随着技术的发展,GIS 已经广泛应用于各个领域,成为现代社会不可或缺的一部分。同时,GIS 也在不断地发展和完善,以适应更多领域的需求。
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

深入了解MATLAB开根号的最新研究和应用:获取开根号领域的最新动态

![matlab开根号](https://www.mathworks.com/discovery/image-segmentation/_jcr_content/mainParsys3/discoverysubsection_1185333930/mainParsys3/image_copy.adapt.full.medium.jpg/1712813808277.jpg) # 1. MATLAB开根号的理论基础 开根号运算在数学和科学计算中无处不在。在MATLAB中,开根号可以通过多种函数实现,包括`sqrt()`和`nthroot()`。`sqrt()`函数用于计算正实数的平方根,而`nt
recommend-type

react的函数组件的使用

React 的函数组件是一种简单的组件类型,用于定义无状态或者只读组件。 它们通常接受一个 props 对象作为参数并返回一个 React 元素。 函数组件的优点是代码简洁、易于测试和重用,并且它们使 React 应用程序的性能更加出色。 您可以使用函数组件来呈现简单的 UI 组件,例如按钮、菜单、标签或其他部件。 您还可以将它们与 React 中的其他组件类型(如类组件或 Hooks)结合使用,以实现更复杂的 UI 交互和功能。
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。奥利维尔,"站在巨人的肩膀上"这句话对你来说完全有意义了。从科学上讲,你知道在这篇论文的(许多)错误中,你是我可以依
recommend-type

解决MATLAB开根号常见问题:提供开根号运算的解决方案

![解决MATLAB开根号常见问题:提供开根号运算的解决方案](https://img-blog.csdnimg.cn/d939d1781acc404d8c826e8af207e68f.png) # 1. MATLAB开根号运算基础** MATLAB开根号运算用于计算一个数的平方根。其语法为: ``` y = sqrt(x) ``` 其中: * `x`:要开根号的数或数组 * `y`:开根号的结果 开根号运算的输入可以是实数、复数、矩阵或数组。对于实数,开根号运算返回一个非负实数。对于复数,开根号运算返回一个复数。对于矩阵或数组,开根号运算逐元素执行,对每个元素进行开根号运算。 #