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

时间: 2024-04-30 20:19:19 浏览: 133
以下是一份基于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

基于Andorid的音乐播放器项目改进版本设计.zip

基于Andorid的音乐播放器项目改进版本设计实现源码,主要针对计算机相关专业的正在做毕设的学生和需要项目实战练习的学习者,也可作为课程设计、期末大作业。
recommend-type

uniapp-machine-learning-from-scratch-05.rar

uniapp-machine-learning-from-scratch-05.rar
recommend-type

game_patch_1.30.21.13250.pak

game_patch_1.30.21.13250.pak
recommend-type

【毕业设计-java】springboot-vue计算机学院校友网源码(完整前后端+mysql+说明文档+LunW).zip

【毕业设计-java】springboot-vue计算机学院校友网源码(完整前后端+mysql+说明文档+LunW).zip
recommend-type

Windows下操作Linux图形界面的VNC工具

在信息技术领域,能够实现操作系统之间便捷的远程访问是非常重要的。尤其在实际工作中,当需要从Windows系统连接到远程的Linux服务器时,使用图形界面工具将极大地提高工作效率和便捷性。本文将详细介绍Windows连接Linux的图形界面工具的相关知识点。 首先,从标题可以看出,我们讨论的是一种能够让Windows用户通过图形界面访问Linux系统的方法。这里的图形界面工具是指能够让用户在Windows环境中,通过图形界面远程操控Linux服务器的软件。 描述部分重复强调了工具的用途,即在Windows平台上通过图形界面访问Linux系统的图形用户界面。这种方式使得用户无需直接操作Linux系统,即可完成管理任务。 标签部分提到了两个关键词:“Windows”和“连接”,以及“Linux的图形界面工具”,这进一步明确了我们讨论的是Windows环境下使用的远程连接Linux图形界面的工具。 在文件的名称列表中,我们看到了一个名为“vncview.exe”的文件。这是VNC Viewer的可执行文件,VNC(Virtual Network Computing)是一种远程显示系统,可以让用户通过网络控制另一台计算机的桌面。VNC Viewer是一个客户端软件,它允许用户连接到VNC服务器上,访问远程计算机的桌面环境。 VNC的工作原理如下: 1. 服务端设置:首先需要在Linux系统上安装并启动VNC服务器。VNC服务器监听特定端口,等待来自客户端的连接请求。在Linux系统上,常用的VNC服务器有VNC Server、Xvnc等。 2. 客户端连接:用户在Windows操作系统上使用VNC Viewer(如vncview.exe)来连接Linux系统上的VNC服务器。连接过程中,用户需要输入远程服务器的IP地址以及VNC服务器监听的端口号。 3. 认证过程:为了保证安全性,VNC在连接时可能会要求输入密码。密码是在Linux系统上设置VNC服务器时配置的,用于验证用户的身份。 4. 图形界面共享:一旦认证成功,VNC Viewer将显示远程Linux系统的桌面环境。用户可以通过VNC Viewer进行操作,如同操作本地计算机一样。 使用VNC连接Linux图形界面工具的好处包括: - 与Linux系统的图形用户界面进行交互,便于进行图形化操作。 - 方便的远程桌面管理,尤其适用于需要通过图形界面来安装软件、编辑配置文件、监控系统状态等场景。 - 跨平台操作,允许Windows用户在不离开他们熟悉的操作系统环境下访问Linux服务器。 除了VNC之外,还有一些其他的图形界面远程访问工具,例如: - RDP(Remote Desktop Protocol):通常与Windows远程桌面连接使用,但在Linux中也有相应的实现(如FreeRDP)。 - TeamViewer、AnyDesk等:这些工具提供了跨平台的远程桌面访问能力,虽然它们不是专为Linux设计,但它们都能很好地支持Linux系统。 在使用这些工具时,用户应该注意以下几点: - 安全性:确保使用强密码以及加密连接,防止未经授权的访问。 - 网络环境:需要保证网络的稳定性和带宽,以获得良好的远程桌面体验。 - 更新与维护:定期更新客户端和服务器端软件,确保安全性以及新功能的使用。 总结以上内容,Windows连接Linux图形界面的工具是实现跨平台远程管理的有效手段,特别是对于需要图形化操作的场景。VNC Viewer是一个应用广泛且成熟的工具,但选择适合自身需求的远程桌面工具对于提高工作效率与安全性至关重要。
recommend-type

【SketchUp Ruby API:从入门到精通】

# 摘要 本论文深入介绍了SketchUp Ruby API的使用与开发,为用户提供了一套从基础到进阶再到高级特性的完整学习路径。文章首先介绍了SketchUp Ruby API的基本概念、结构以及如何编写基础插件,并通过实例演示了3D模型的创建和编辑、用户界面定制等进阶应用。接着,探讨了高级特性,例如材质渲染、网络功能以及AP
recommend-type

VMware虚拟机打开虚拟网络编辑器出现由于找不到vnetlib.dll,无法继续执行代码。重新安装程序可能会解决问题

<think>好的,我需要帮助用户解决VMware虚拟机中缺少vnetlib.dll导致无法打开虚拟网络编辑器的问题。用户提到已经尝试过重新安装程序,但可能没有彻底卸载之前的残留文件。根据提供的引用资料,特别是引用[2]、[3]、[4]、[5],问题通常是由于VMware卸载不干净导致的。 首先,我应该列出彻底卸载VMware的步骤,包括关闭相关服务、使用卸载工具、清理注册表和文件残留,以及删除虚拟网卡。然后,建议重新安装最新版本的VMware。可能还需要提醒用户在安装后检查网络适配器设置,确保虚拟网卡正确安装。同时,用户可能需要手动恢复vnetlib.dll文件,但更安全的方法是通过官方安
recommend-type

基于Preact的高性能PWA实现定期天气信息更新

### 知识点详解 #### 1. React框架基础 React是由Facebook开发和维护的JavaScript库,专门用于构建用户界面。它是基于组件的,使得开发者能够创建大型的、动态的、数据驱动的Web应用。React的虚拟DOM(Virtual DOM)机制能够高效地更新和渲染界面,这是因为它仅对需要更新的部分进行操作,减少了与真实DOM的交互,从而提高了性能。 #### 2. Preact简介 Preact是一个与React功能相似的轻量级JavaScript库,它提供了React的核心功能,但体积更小,性能更高。Preact非常适合于需要快速加载和高效执行的场景,比如渐进式Web应用(Progressive Web Apps, PWA)。由于Preact的API与React非常接近,开发者可以在不牺牲太多现有React知识的情况下,享受到更轻量级的库带来的性能提升。 #### 3. 渐进式Web应用(PWA) PWA是一种设计理念,它通过一系列的Web技术使得Web应用能够提供类似原生应用的体验。PWA的特点包括离线能力、可安装性、即时加载、后台同步等。通过PWA,开发者能够为用户提供更快、更可靠、更互动的网页应用体验。PWA依赖于Service Workers、Manifest文件等技术来实现这些特性。 #### 4. Service Workers Service Workers是浏览器的一个额外的JavaScript线程,它可以拦截和处理网络请求,管理缓存,从而让Web应用可以离线工作。Service Workers运行在浏览器后台,不会影响Web页面的性能,为PWA的离线功能提供了技术基础。 #### 5. Web应用的Manifest文件 Manifest文件是PWA的核心组成部分之一,它是一个简单的JSON文件,为Web应用提供了名称、图标、启动画面、显示方式等配置信息。通过配置Manifest文件,可以定义PWA在用户设备上的安装方式以及应用的外观和行为。 #### 6. 天气信息数据获取 为了提供定期的天气信息,该应用需要接入一个天气信息API服务。开发者可以使用各种公共的或私有的天气API来获取实时天气数据。获取数据后,应用会解析这些数据并将其展示给用户。 #### 7. Web应用的性能优化 在开发过程中,性能优化是确保Web应用反应迅速和资源高效使用的关键环节。常见的优化技术包括但不限于减少HTTP请求、代码分割(code splitting)、懒加载(lazy loading)、优化渲染路径以及使用Preact这样的轻量级库。 #### 8. 压缩包子文件技术 “压缩包子文件”的命名暗示了该应用可能使用了某种形式的文件压缩技术。在Web开发中,这可能指将多个文件打包成一个或几个体积更小的文件,以便更快地加载。常用的工具有Webpack、Rollup等,这些工具可以将JavaScript、CSS、图片等资源进行压缩、合并和优化,从而减少网络请求,提升页面加载速度。 综上所述,本文件描述了一个基于Preact构建的高性能渐进式Web应用,它能够提供定期天气信息。该应用利用了Preact的轻量级特性和PWA技术,以实现快速响应和离线工作的能力。开发者需要了解React框架、Preact的优势、Service Workers、Manifest文件配置、天气数据获取和Web应用性能优化等关键知识点。通过这些技术,可以为用户提供一个加载速度快、交互流畅且具有离线功能的应用体验。
recommend-type

从停机到上线,EMC VNX5100控制器SP更换的实战演练

# 摘要 本文详细介绍了EMC VNX5100控制器的更换流程、故障诊断、停机保护、系统恢复以及长期监控与预防性维护策略。通过细致的准备工作、详尽的风险评估以及备份策略的制定,确保控制器更换过程的安全性与数据的完整性。文中还阐述了硬件故障诊断方法、系统停机计划的制定以及数据保护步骤。更换操作指南和系统重启初始化配置得到了详尽说明,以确保系统功能的正常恢复与性能优化。最后,文章强调了性能测试