在gd32f103单片机环境下,无舵机的智能车通过pd算法进行电磁循迹,并使用HC-SR04超声波测距模块进行避障的代码

时间: 2024-04-30 14:19:19 浏览: 104
ZIP

基于stm32的具有循迹避障的智能车的电路图设计

以下是一份基于GD32F103单片机环境下的无舵机电磁循迹与超声波避障代码,使用PD算法控制电机速度,具体实现细节需要根据具体硬件环境进行适当调整: ```c #include "gd32f10x.h" #include "systick.h" /* 定义电机控制相关的宏 */ #define MOT1_PORT GPIOB #define MOT1_PWM GPIO_PIN_0 #define MOT1_DIR1 GPIO_PIN_1 #define MOT1_DIR2 GPIO_PIN_2 #define MOT2_PORT GPIOB #define MOT2_PWM GPIO_PIN_8 #define MOT2_DIR1 GPIO_PIN_9 #define MOT2_DIR2 GPIO_PIN_10 /* 定义红外循迹传感器引脚相关的宏 */ #define IR_PORT GPIOA #define IR_L1 GPIO_PIN_0 #define IR_L2 GPIO_PIN_1 #define IR_M1 GPIO_PIN_2 #define IR_M2 GPIO_PIN_3 #define IR_R1 GPIO_PIN_4 #define IR_R2 GPIO_PIN_5 /* 定义超声波模块引脚相关的宏 */ #define US_PORT GPIOA #define US_TRIG GPIO_PIN_6 #define US_ECHO GPIO_PIN_7 /* 定义全局变量 */ float error = 0; float last_error = 0; float kp = 0.3; float kd = 0.2; int speed = 0; /* 定义函数原型 */ void motor_control(int left_speed, int right_speed); void ir_track(void); void us_measure(void); int main(void) { /* 初始化SysTick */ delay_init(72); /* 使能GPIOB和GPIOA时钟 */ rcu_periph_clock_enable(RCU_GPIOB); rcu_periph_clock_enable(RCU_GPIOA); /* 配置MOT1_PWM、MOT1_DIR1和MOT1_DIR2引脚为推挽输出 */ gpio_init(MOT1_PORT, GPIO_MODE_AF_PP, GPIO_OSPEED_50MHZ, MOT1_PWM | MOT1_DIR1 | MOT1_DIR2); /* 配置MOT2_PWM、MOT2_DIR1和MOT2_DIR2引脚为推挽输出 */ gpio_init(MOT2_PORT, GPIO_MODE_AF_PP, GPIO_OSPEED_50MHZ, MOT2_PWM | MOT2_DIR1 | MOT2_DIR2); /* 配置IR_L1、IR_L2、IR_M1、IR_M2、IR_R1和IR_R2引脚为浮空输入 */ gpio_init(IR_PORT, GPIO_MODE_IPU, GPIO_OSPEED_50MHZ, IR_L1 | IR_L2 | IR_M1 | IR_M2 | IR_R1 | IR_R2); /* 配置US_TRIG引脚为推挽输出 */ gpio_init(US_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, US_TRIG); /* 配置US_ECHO引脚为浮空输入 */ gpio_init(US_PORT, GPIO_MODE_IPU, GPIO_OSPEED_50MHZ, US_ECHO); /* 设置SysTick的中断周期为10ms */ SysTick_Config(SystemCoreClock / 100); while(1) { /* 电磁循迹 */ ir_track(); /* 超声波避障 */ us_measure(); /* 根据PD算法计算电机速度 */ speed = kp * error + kd * (error - last_error); last_error = error; /* 控制电机速度 */ motor_control(speed, speed); } } /* 电机控制函数 */ void motor_control(int left_speed, int right_speed) { /* 控制左电机 */ if(left_speed > 0) { /* 向前 */ gpio_bit_set(MOT1_PORT, MOT1_DIR1); gpio_bit_reset(MOT1_PORT, MOT1_DIR2); pwm_output_state_set(PWM1, ENABLE); timer_channel_output_pulse_value_config(PWM1, TIMER_CH_0, left_speed); } else if(left_speed < 0) { /* 向后 */ gpio_bit_reset(MOT1_PORT, MOT1_DIR1); gpio_bit_set(MOT1_PORT, MOT1_DIR2); pwm_output_state_set(PWM1, ENABLE); timer_channel_output_pulse_value_config(PWM1, TIMER_CH_0, -left_speed); } else { /* 停止 */ gpio_bit_reset(MOT1_PORT, MOT1_DIR1); gpio_bit_reset(MOT1_PORT, MOT1_DIR2); pwm_output_state_set(PWM1, DISABLE); } /* 控制右电机 */ if(right_speed > 0) { /* 向前 */ gpio_bit_set(MOT2_PORT, MOT2_DIR1); gpio_bit_reset(MOT2_PORT, MOT2_DIR2); pwm_output_state_set(PWM0, ENABLE); timer_channel_output_pulse_value_config(PWM0, TIMER_CH_2, right_speed); } else if(right_speed < 0) { /* 向后 */ gpio_bit_reset(MOT2_PORT, MOT2_DIR1); gpio_bit_set(MOT2_PORT, MOT2_DIR2); pwm_output_state_set(PWM0, ENABLE); timer_channel_output_pulse_value_config(PWM0, TIMER_CH_2, -right_speed); } else { /* 停止 */ gpio_bit_reset(MOT2_PORT, MOT2_DIR1); gpio_bit_reset(MOT2_PORT, MOT2_DIR2); pwm_output_state_set(PWM0, DISABLE); } } /* 电磁循迹函数 */ void ir_track(void) { uint16_t ir_l1 = gpio_input_bit_get(IR_PORT, IR_L1); uint16_t ir_l2 = gpio_input_bit_get(IR_PORT, IR_L2); uint16_t ir_m1 = gpio_input_bit_get(IR_PORT, IR_M1); uint16_t ir_m2 = gpio_input_bit_get(IR_PORT, IR_M2); uint16_t ir_r1 = gpio_input_bit_get(IR_PORT, IR_R1); uint16_t ir_r2 = gpio_input_bit_get(IR_PORT, IR_R2); if(ir_l1 == 0 && ir_l2 == 0 && ir_m1 == 0 && ir_m2 == 0 && ir_r1 == 0 && ir_r2 == 0) { error = 0; } else if(ir_l1 == 1 && ir_l2 == 0 && ir_m1 == 0 && ir_m2 == 0 && ir_r1 == 0 && ir_r2 == 0) { error = -3; } else if(ir_l1 == 1 && ir_l2 == 1 && ir_m1 == 0 && ir_m2 == 0 && ir_r1 == 0 && ir_r2 == 0) { error = -2; } else if(ir_l1 == 0 && ir_l2 == 1 && ir_m1 == 0 && ir_m2 == 0 && ir_r1 == 0 && ir_r2 == 0) { error = -1; } else if(ir_l1 == 0 && ir_l2 == 1 && ir_m1 == 1 && ir_m2 == 0 && ir_r1 == 0 && ir_r2 == 0) { error = -0.5; } else if(ir_l1 == 0 && ir_l2 == 0 && ir_m1 == 1 && ir_m2 == 0 && ir_r1 == 0 && ir_r2 == 0) { error = 0; } else if(ir_l1 == 0 && ir_l2 == 0 && ir_m1 == 1 && ir_m2 == 1 && ir_r1 == 0 && ir_r2 == 0) { error = 0.5; } else if(ir_l1 == 0 && ir_l2 == 0 && ir_m1 == 0 && ir_m2 == 1 && ir_r1 == 0 && ir_r2 == 0) { error = 1; } else if(ir_l1 == 0 && ir_l2 == 0 && ir_m1 == 0 && ir_m2 == 1 && ir_r1 == 1 && ir_r2 == 0) { error = 2; } else if(ir_l1 == 0 && ir_l2 == 0 && ir_m1 == 0 && ir_m2 == 0 && ir_r1 == 1 && ir_r2 == 0) { error = 3; } else if(ir_l1 == 0 && ir_l2 == 0 && ir_m1 == 0 && ir_m2 == 0 && ir_r1 == 1 && ir_r2 == 1) { error = 4; } } /* 超声波测距函数 */ void us_measure(void) { uint32_t start_time = 0; uint32_t end_time = 0; uint32_t distance = 0; /* 发送超声波信号 */ gpio_bit_set(US_PORT, US_TRIG); delay_us(10); gpio_bit_reset(US_PORT, US_TRIG); /* 等待收到回波信号 */ while(!gpio_input_bit_get(US_PORT, US_ECHO)); start_time = systick_get_value(); while(gpio_input_bit_get(US_PORT, US_ECHO)); end_time = systick_get_value(); /* 计算距离 */ distance = (end_time - start_time) / 58; /* 超声波避障 */ if(distance < 10) { /* 靠近障碍物,需要向右转 */ error += 2; } } ``` 需要注意的是,以上代码中只是一个简单的示例,实际的应用场景中需要根据具体情况进行调整和优化,例如增加PID算法等更高级的控制算法,以达到更好的效果。
阅读全文

相关推荐

最新推荐

recommend-type

STM32实现智能小车电磁循迹

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

基于CCD摄像头智能车分段PID控制算法设计

通过这样的分段PID控制,智能车能够在各种赛道条件下实现精确的循迹和灵活的转弯,从而提高比赛性能。这种方法综合考虑了图像处理、实时控制和机械执行的复杂性,是智能车竞赛中一项重要的技术实现。
recommend-type

飞思卡尔智能车竞赛线性CCD(光电)组-参考程序

通过这些技术,可以从背景中分离出赛道黑线,并将其转化为控制指令,驱动电机和舵机,使得智能车能够按照黑线轨迹前进。 综上所述,飞思卡尔智能车竞赛线性CCD组的参考程序涵盖了滤波、动态阈值设置、曲率计算、...
recommend-type

四轮小车,智能小车,1-安装图.docx

本文档提供了四轮智能小车的设计与安装指南,涵盖了小车的 PID 控制系统、舵机控制原理、单片机控制系统、超声波模块安装等方面的知识点。 一、四轮智能小车 PID 控制系统设计 PID 控制系统是四轮智能小车的核心...
recommend-type

浅谈智能车的制作--献给电赛控制类或者业余的菜鸟们

智能车制作概述 本文主要讨论智能车的制作,着重于控制类和电赛控制类的设计思路和方案。文章分为四大部分:选择微控制器、电机的选择、电机驱动的选择和转速的测量。 一、选择微控制器 在智能车制作中,选择合适...
recommend-type

黑板风格计算机毕业答辩PPT模板下载

资源摘要信息:"创意经典黑板风格毕业答辩论文课题报告动态ppt模板" 在当前数字化教学与展示需求日益增长的背景下,PPT模板成为了表达和呈现学术成果及教学内容的重要工具。特别针对计算机专业的学生而言,毕业设计的答辩PPT不仅仅是一个展示的平台,更是其设计能力、逻辑思维和审美观的综合体现。因此,一个恰当且创意十足的PPT模板显得尤为重要。 本资源名为“创意经典黑板风格毕业答辩论文课题报告动态ppt模板”,这表明该模板具有以下特点: 1. **创意设计**:模板采用了“黑板风格”的设计元素,这种风格通常模拟传统的黑板书写效果,能够营造一种亲近、随性的学术氛围。该风格的模板能够帮助展示者更容易地吸引观众的注意力,并引发共鸣。 2. **适应性强**:标题表明这是一个毕业答辩用的模板,它适用于计算机专业及其他相关专业的学生用于毕业设计课题的汇报。模板中设计的版式和内容布局应该是灵活多变的,以适应不同课题的展示需求。 3. **动态效果**:动态效果能够使演示内容更富吸引力,模板可能包含了多种动态过渡效果、动画效果等,使得展示过程生动且充满趣味性,有助于突出重点并维持观众的兴趣。 4. **专业性质**:由于是毕业设计用的模板,因此该模板在设计时应充分考虑了计算机专业的特点,可能包括相关的图表、代码展示、流程图、数据可视化等元素,以帮助学生更好地展示其研究成果和技术细节。 5. **易于编辑**:一个良好的模板应具备易于编辑的特性,这样使用者才能根据自己的需要进行调整,比如替换文本、修改颜色主题、更改图片和图表等,以确保最终展示的个性和专业性。 结合以上特点,模板的使用场景可以包括但不限于以下几种: - 计算机科学与技术专业的学生毕业设计汇报。 - 计算机工程与应用专业的学生论文展示。 - 软件工程或信息技术专业的学生课题研究成果展示。 - 任何需要进行学术成果汇报的场合,比如研讨会议、学术交流会等。 对于计算机专业的学生来说,毕业设计不仅仅是完成一个课题,更重要的是通过这个过程学会如何系统地整理和表述自己的思想。因此,一份好的PPT模板能够帮助他们更好地完成这个任务,同时也能够展现出他们的专业素养和对细节的关注。 此外,考虑到模板是一个压缩文件包(.zip格式),用户在使用前需要解压缩,解压缩后得到的文件为“创意经典黑板风格毕业答辩论文课题报告动态ppt模板.pptx”,这是一个可以直接在PowerPoint软件中打开和编辑的演示文稿文件。用户可以根据自己的具体需要,在模板的基础上进行修改和补充,以制作出一个具有个性化特色的毕业设计答辩PPT。
recommend-type

管理建模和仿真的文件

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

提升点阵式液晶显示屏效率技术

![点阵式液晶显示屏显示程序设计](https://iot-book.github.io/23_%E5%8F%AF%E8%A7%81%E5%85%89%E6%84%9F%E7%9F%A5/S3_%E8%A2%AB%E5%8A%A8%E5%BC%8F/fig/%E8%A2%AB%E5%8A%A8%E6%A0%87%E7%AD%BE.png) # 1. 点阵式液晶显示屏基础与效率挑战 在现代信息技术的浪潮中,点阵式液晶显示屏作为核心显示技术之一,已被广泛应用于从智能手机到工业控制等多个领域。本章节将介绍点阵式液晶显示屏的基础知识,并探讨其在提升显示效率过程中面临的挑战。 ## 1.1 点阵式显
recommend-type

在SoC芯片的射频测试中,ATE设备通常如何执行系统级测试以保证芯片量产的质量和性能一致?

SoC芯片的射频测试是确保无线通信设备性能的关键环节。为了在量产阶段保证芯片的质量和性能一致性,ATE(Automatic Test Equipment)设备通常会执行一系列系统级测试。这些测试不仅关注芯片的电气参数,还包含电磁兼容性和射频信号的完整性检验。在ATE测试中,会根据芯片设计的规格要求,编写定制化的测试脚本,这些脚本能够模拟真实的无线通信环境,检验芯片的射频部分是否能够准确处理信号。系统级测试涉及对芯片基带算法的验证,确保其能够有效执行无线信号的调制解调。测试过程中,ATE设备会自动采集数据并分析结果,对于不符合标准的芯片,系统能够自动标记或剔除,从而提高测试效率和减少故障率。为了
recommend-type

CodeSandbox实现ListView快速创建指南

资源摘要信息:"listview:用CodeSandbox创建" 知识点一:CodeSandbox介绍 CodeSandbox是一个在线代码编辑器,专门为网页应用和组件的快速开发而设计。它允许用户即时预览代码更改的效果,并支持多种前端开发技术栈,如React、Vue、Angular等。CodeSandbox的特点是易于使用,支持团队协作,以及能够直接在浏览器中编写代码,无需安装任何软件。因此,它非常适合初学者和快速原型开发。 知识点二:ListView组件 ListView是一种常用的用户界面组件,主要用于以列表形式展示一系列的信息项。在前端开发中,ListView经常用于展示从数据库或API获取的数据。其核心作用是提供清晰的、结构化的信息展示方式,以便用户可以方便地浏览和查找相关信息。 知识点三:用JavaScript创建ListView 在JavaScript中创建ListView通常涉及以下几个步骤: 1. 创建HTML的ul元素作为列表容器。 2. 使用JavaScript的DOM操作方法(如document.createElement, appendChild等)动态创建列表项(li元素)。 3. 将创建的列表项添加到ul容器中。 4. 通过CSS来设置列表和列表项的样式,使其符合设计要求。 5. (可选)为ListView添加交互功能,如点击事件处理,以实现更丰富的用户体验。 知识点四:在CodeSandbox中创建ListView 在CodeSandbox中创建ListView可以简化开发流程,因为它提供了一个在线环境来编写代码,并且支持实时预览。以下是使用CodeSandbox创建ListView的简要步骤: 1. 打开CodeSandbox官网,创建一个新的项目。 2. 在项目中创建或编辑HTML文件,添加用于展示ListView的ul元素。 3. 创建或编辑JavaScript文件,编写代码动态生成列表项,并将它们添加到ul容器中。 4. 使用CodeSandbox提供的实时预览功能,即时查看ListView的效果。 5. 若有需要,继续编辑或添加样式文件(通常是CSS),对ListView进行美化。 6. 利用CodeSandbox的版本控制功能,保存工作进度和团队协作。 知识点五:实践案例分析——listview-main 文件名"listview-main"暗示这可能是一个展示如何使用CodeSandbox创建基本ListView的项目。在这个项目中,开发者可能会包含以下内容: 1. 使用React框架创建ListView的示例代码,因为React是目前较为流行的前端库。 2. 展示如何将从API获取的数据渲染到ListView中,包括数据的获取、处理和展示。 3. 提供基本的样式设置,展示如何使用CSS来美化ListView。 4. 介绍如何在CodeSandbox中组织项目结构,例如如何分离组件、样式和脚本文件。 5. 包含一个简单的用户交互示例,例如点击列表项时弹出详细信息等。 总结来说,通过标题“listview:用CodeSandbox创建”,我们了解到本资源是一个关于如何利用CodeSandbox这个在线开发环境,来快速实现一个基于JavaScript的ListView组件的教程或示例项目。通过上述知识点的梳理,可以加深对如何创建ListView组件、CodeSandbox平台的使用方法以及如何在该平台中实现具体功能的理解。