#include<stm32f10x.h> #include"sys.h" extern unsigned char Rec_Dat_U1; extern unsigned char Rec_String_U1[200]; extern int conut_flag_1; #define in_1(x) x?GPIO_ResetBits(GPIOC , GPIO_Pin_0): GPIO_SetBits(GPIOC , GPIO_Pin_0) #define in_2(x) x?GPIO_ResetBits(GPIOC , GPIO_Pin_1): GPIO_SetBits(GPIOC , GPIO_Pin_1) #define in_3(x) x?GPIO_ResetBits(GPIOB , GPIO_Pin_10): GPIO_SetBits(GPIOB , GPIO_Pin_10) #define in_4(x) x?GPIO_ResetBits(GPIOB , GPIO_Pin_11): GPIO_SetBits(GPIOB , GPIO_Pin_11) #define key_1 GPIO_ReadInputDataBit(GPIOD, GPIO_Pin_12) #define key_2 GPIO_ReadInputDataBit(GPIOD, GPIO_Pin_13) #define key_3 GPIO_ReadInputDataBit(GPIOD, GPIO_Pin_14) #define key_4 GPIO_ReadInputDataBit(GPIOD, GPIO_Pin_15) float Kp_l = 0.82 ; //比例常数 float Ti_l = 0.09 ; //微分时间常数 float Td_l = 0.015 ; //采样周期 float Kp_r = 0.20 ; float Ti_r = 0.09 ; float Td_r = 0.015 ; #define T 0.02 #define Ki_l Kp_l*(T/Ti_l) // Kp Ki Kd #define Kd_l Kp_l*(Td_l/T) #define Ki_r Kp_l*(T/Ti_l) // Kp Ki Kd #define Kd_r Kp_l*(Td_l/T) #define left_b in_1(1); in_2(0); #define left_f in_1(0); in_2(1); #define right_f in_3(1); in_4(0); #define right_b in_1(0); in_2(1); extern float pwm_l; extern float pwm_r; void CAR_GPIO_INIT(void); int main() { // int speed=50; SYS_CONFIG(); CAR_GPIO_INIT(); pwm_init(TIM3_1); pwm_init(TIM3_2); TIM4_PWMINPUT_INIT(0xffff,31); //1M速度采样率 TIM5_PWMINPUT_INIT(0xffff,31); incPIDinit(); PID_set(Kp_l,Ki_l,Kd_l,Kp_r,Ki_r,Kd_r); //void PID_set(float pp_1,float ii_1,float dd_1,float pp_2,float ii_2,float dd_2) right_f left_f // set_pwm_percent(TIM3_1,50) ; // set_pwm_percent(TIM3_2,50) ; PID_setpoint(&PID_l, 160); PID_setpoint(&PID_r, 160); while(1) { printf("%d\r\n",(int)pwm_l); delay_ms(200); } } void CAR_GPIO_INIT() { GPIO_InitTypeDef GPIO_InitStructure; RCC_APB2PeriphClockCmd( RCC_APB2Periph_GPIOC|RCC_APB2Periph_GPIOB|RCC_APB2Periph_GPIOD, ENABLE); GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz; GPIO_Init(GPIOB, &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = GPIO_Pin_11; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz; GPIO_Init(GPIOB, &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz; GPIO_Init(GPIOC, &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz; GPIO_Init(GPIOC, &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU; GPIO_Init(GPIOD, &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = GPIO_Pin_13; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU; GPIO_Init(GPIOD, &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = GPIO_Pin_14; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU; GPIO_Init(GPIOD, &GPIO_InitStructure); GPIO_InitStructure.GPIO_Pin = GPIO_Pin_15; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU; GPIO_Init(GPIOD, &GPIO_InitStructure); }

时间: 2025-06-17 17:07:41 浏览: 18
这段代码展示了基于STM32F10x系列单片机的小车控制程序的一部分。它通过初始化GPIO端口,并设置了一些用于控制电机和读取按键状态的宏定义,还包含了一个简单的主循环,在其中调用了PID控制器的相关函数。 ### 主要功能分析 #### 引入头文件及外部变量声明 ```c #include <stm32f10x.h> #include "sys.h" extern unsigned char Rec_Dat_U1; extern unsigned char Rec_String_U1[200]; extern int count_flag_1; ``` 这部分引入了必要的库以及一些全局使用的外部变量。 #### 宏定义 - 控制信号生成与状态检测 ```c #define in_1(x) x ? GPIO_ResetBits(GPIOC, GPIO_Pin_0) : GPIO_SetBits(GPIOC, GPIO_Pin_0) ... #define key_4 GPIO_ReadInputDataBit(GPIOD, GPIO_Pin_15) ``` 这些`#define`语句简化了对特定IO管脚的操作命令,比如驱动马达的方向、停止等动作;同时也能方便地获取按钮的状态信息。 #### PID 参数配置 ```c float Kp_l = 0.82; // 左侧轮子的比例系数 float Ti_l = 0.09; // 积分时间常数 float Td_l = 0.015; float Kp_r = 0.20; // 右侧轮子的比例系数 float Ti_r = 0.09; float Td_r = 0.015; #define T 0.02 #define Ki_l Kp_l * (T / Ti_l) #define Kd_l Kp_l * (Td_l / T) #define Ki_r Kp_r * (T / Ti_r) #define Kd_r Kp_r * (Td_r / T) ``` 这里设置了左右两侧轮子对应的PID调节器的比例(P),积分(I),微分(D)三个关键参数值,之后又根据给定的时间间隔\( T \),计算出了实际应用中的Ki和Kd数值。 #### 初始化外设并启动任务 接下来的部分主要是对外部设备进行初始化工作,包括PWM模块、定时器以及其他硬件资源: - `SYS_CONFIG();`: 系统基本配置; - `CAR_GPIO_INIT();`: 配置所有需要用到的GPIO引脚; - 对两个通道分别进行了PWM初始化(`TIM3_1`, `TIM3_2`) 和 PWM 输入模式 (`TIM4`, `TIM5`); - 调用自定义函数完成PID算法的初始设定:`incPIDinit()` -> 增量式PID初始化; - 设定了左侧和右侧目标转速为160rpm左右(假设单位是RPM),即 `PID_setpoint(&PID_l, 160)` 和 `PID_setpoint(&PID_r, 160)`。 最后进入死循环不断打印当前左轮的速度百分比,并每隔一段时间延时一次。 ### 关键点解析 - **I/O 操作** : 使用了大量的宏定义来简化 I/O 的操作过程。 - **PID 控制** : 根据预先设定好的比例、积分及时刻调整规则来进行速度闭环反馈控制。 - **系统架构设计合理化**: 分离式的编码风格使得每个部分职责明确易于维护更新。
阅读全文

相关推荐

#include <cuda_runtime.h> #include <device_launch_parameters.h> #include <algorithm> // 中值滤波核函数 __global__ void medianFilterKernel(unsigned char* input, unsigned char* output, int width, int height, int kernelSize) { int x = blockIdx.x * blockDim.x + threadIdx.x; int y = blockIdx.y * blockDim.y + threadIdx.y; if (x < width && y < height) { int halfKernel = kernelSize / 2; int count = 0; unsigned char values[81]; // 假设最大核大小为9x9 for (int ky = -halfKernel; ky <= halfKernel; ky++) { for (int kx = -halfKernel; kx <= halfKernel; kx++) { int nx = x + kx; int ny = y + ky; if (nx >= 0 && nx < width && ny >= 0 && ny < height) { values[count++] = input[ny * width + nx]; } } } std::sort(values, values + count); output[y * width + x] = values[count / 2]; } } // 封装的中值滤波函数,用于导出到DLL extern "C" __declspec(dllexport) void MedianFilterCUDA(unsigned char* input, unsigned char* output, int width, int height, int kernelSize) { unsigned char* d_input; unsigned char* d_output; // 分配GPU内存 cudaMalloc((void**)&d_input, width * height * sizeof(unsigned char)); cudaMalloc((void**)&d_output, width * height * sizeof(unsigned char)); // 将数据从主机复制到GPU cudaMemcpy(d_input, input, width * height * sizeof(unsigned char), cudaMemcpyHostToDevice); // 定义线程块和网格大小 dim3 blockSize(16, 16); dim3 gridSize((width + blockSize.x - 1) / blockSize.x, (height + blockSize.y - 1) / blockSize.y); // 调用核函数 medianFilterKernel <<<gridSize, blockSize >>> (d_input, d_output, width, height, kernelSize); // 将数据从GPU复制到主机 cudaMemcpy(output, d_output, width * height * sizeof(unsigned char), cudaMemcpyDeviceToHost); // 释放GPU内存 cudaFree(d_input); cudaFree(d_output); } 就是这个为什么一直<<<提示应输入表达式

/* 修改后的MatrixLED.h */ #ifndef __MATRIX_LED_H__ #define __MATRIX_LED_H__ #include <REGX52.H> void MatrixLED_Init(); void MatrixLED_SC(unsigned char lie, unsigned char hang); void Timer0_Init(); extern volatile unsigned char Offset; // 声明全局变量 extern volatile unsigned char speed_threshold; #endif /* 修改后的MatrixLED.c */ #include "MatrixLED.h" #include "Delay.h" sbit SER = P3^4; sbit RCK = P3^5; sbit SCK = P3^6; #define MATRIX_LED_PORT P0 volatile unsigned char Offset = 0; volatile unsigned char speed_threshold = 10; void _74595_WByte(unsigned char Byte) { /* 原有实现不变 */ } void MatrixLED_Init() { SCK = 0; RCK = 0; Timer0_Init(); // 新增定时器初始化 } void Timer0_Init() { TMOD &= 0xF0; TMOD |= 0x01; TH0 = 0xFC; TL0 = 0x66; // 1ms定时 ET0 = 1; EA = 1; TR0 = 1; } void MatrixLED_SC(unsigned char lie, unsigned char Data) { _74595_WByte(Data); MATRIX_LED_PORT = ~(0x80 >> lie); Delay(1); MATRIX_LED_PORT = 0xFF; } /* 新增定时器中断服务函数 */ void Timer0_ISR() interrupt 1 { static unsigned int count = 0; TH0 = 0xFC; // 重装初值 TL0 = 0x66; if(++count >= speed_threshold) { count = 0; Offset++; if(Offset > 40) Offset = 0; } } /* 修改后的main.c */ #include <REGX52.H> #include "Delay.h" #include "MatrixLED.h" unsigned char code Animation[] = {/* 原有动画数据不变 */}; void main() { unsigned char i; unsigned char key_state = 1; MatrixLED_Init(); while(1) { // 按键检测(假设接在P3.2) if(P3_2 != key_state) { Delay(20); // 消抖 if(P3_2 != key_state) { key_state = P3_2; speed_threshold = (key_state == 0) ? 5 : 10; } } // 刷新显示 for(i=0; i<8; i++) { MatrixLED_SC(i, Animation[i + Offset]); } } } 把这里面的初始速度和加速后的速度改小一些

pdf

最新推荐

recommend-type

2013年春季省开课程网络形考“经营管理实务”第三次作业.doc

2013年春季省开课程网络形考“经营管理实务”第三次作业.doc
recommend-type

【数据科学工具】Anaconda下载安装与配置教程:涵盖系统要求、安装步骤及环境配置

内容概要:本文详细介绍了Anaconda的下载、安装与配置方法(2025最新版)。Anaconda是一个开源的Python/R数据科学集成开发平台,预装了1500多个科学计算库,并提供conda包管理和环境管理功能。文章首先列出了系统要求,接着分别讲述了适用于不同操作系统的下载方式,包括官方下载和国内镜像下载。然后,具体讲解了Windows、macOS和Linux三种操作系统的安装步骤,以及环境变量的手动配置方法。此外,还提供了验证安装是否成功的命令和配置国内镜像源的方法,以提高下载速度。最后,列出了一些常用conda命令和常见问题的解决方案。 适合人群:从事数据科学、机器学习领域的研究人员和开发者,特别是需要频繁使用Python科学计算库的用户。 使用场景及目标:①帮助用户快速搭建Python开发环境,尤其是需要多个Python版本共存或隔离环境的情况下;②解决因网络原因导致的下载速度慢的问题;③提供详细的安装指南,确保安装过程顺利进行;④指导用户正确配置环境变量,避免常见的安装后无法使用的错误。 阅读建议:由于Anaconda涉及多平台安装和配置,建议读者根据自己的操作系统选择相应的章节重点阅读,并严格按照步骤操作。对于初次使用者,建议先从简单的安装入手,再逐步学习环境管理和包管理的相关命令。
recommend-type

综合布线设计内容.doc

综合布线设计内容.doc
recommend-type

成功的项目管理.docx

成功的项目管理.docx
recommend-type

前端分析-202307110078988

前端分析-202307110078988
recommend-type

cc65 Windows完整版发布:6502 C开发工具

cc65是一个针对6502处理器的完整C编程开发环境,特别适用于Windows操作系统。6502处理器是一种经典的8位微处理器,于1970年代被广泛应用于诸如Apple II、Atari 2600、NES(任天堂娱乐系统)等早期计算机和游戏机中。cc65工具集能够允许开发者使用C语言编写程序,这对于那些希望为这些老旧系统开发软件的程序员来说是一大福音,因为相较于汇编语言,C语言更加高级、易读,并且具备更好的可移植性。 cc65开发工具包主要包含以下几个重要组件: 1. C编译器:这是cc65的核心部分,它能够将C语言源代码编译成6502处理器的机器码。这使得开发者可以用高级语言编写程序,而不必处理低级的汇编指令。 2. 链接器:链接器负责将编译器生成的目标代码和库文件组合成一个单独的可执行程序。在6502的开发环境中,链接器还需要处理各种内存段的定位和映射问题。 3. 汇编器:虽然主要通过C语言进行开发,但某些底层操作仍然可能需要使用汇编语言来实现。cc65包含了一个汇编器,允许程序员编写汇编代码段。 4. 库和运行时:cc65提供了一套标准库,这些库函数为C语言提供了支持,并且对于操作系统级别的功能进行了封装,使得开发者能够更方便地进行编程。运行时支持包括启动代码、中断处理、内存管理等。 5. 开发工具和文档:除了基本的编译、链接和汇编工具外,cc65还提供了一系列辅助工具,如反汇编器、二进制文件编辑器、交叉引用器等。同时,cc65还包含丰富的文档资源,为开发者提供了详尽的使用指南、编程参考和示例代码。 cc65可以广泛用于学习和开发6502架构相关的软件,尤其适合那些对6502处理器、复古计算机或者早期游戏系统有兴趣的开发者。这些开发者可能想要创建或修改旧式游戏、系统软件、仿真器,或者进行技术研究和学习。 尽管cc65是一个功能强大的工具,但它也要求开发者对目标平台的硬件架构和操作系统有足够的了解。这是因为6502并非现代处理器,它对内存访问、I/O操作和中断管理等有着特殊的限制和要求。因此,使用cc65需要开发者具备一定的背景知识,包括但不限于6502指令集、内存映射、硬件寄存器操作等方面的内容。 此外,cc65针对Windows平台进行了优化和封装,使得它可以在Windows操作系统上无缝运行,这对于习惯于Windows环境的用户是一个好消息。不过,如果用户使用的是其他操作系统,可能需要通过相应的兼容层或虚拟机来运行Windows环境,以便使用cc65工具。 总的来说,cc65提供了一种相对简单的方式来开发运行在6502处理器上的软件。它极大地降低了开发难度,使得更多的人能够接触和参与到基于6502平台的软件开发中来,为这个历史悠久的平台注入了新的活力。
recommend-type

【CLIP模型实战】:从数据预处理到代码实现的图文相似度计算完全指南

# 1. CLIP模型概述 在人工智能领域中,CLIP(Contrastive Language-Image Pre-training)模型作为一款开创性的多模态学习技术,已经成为业界瞩目的焦点。CLIP模型是由OpenAI在2021年推出的,其创新之处在于通过大规模的图文对齐数据进行预训练,能够理解和匹配图像与自然语言描述之间的关联性。CLIP突破了传统方法在特定任务上需要大规模标注数据的限制
recommend-type

车载以太网doip协议格式

<think>首先,用户的问题是:“我想查找关于车载以太网DOIP协议的数据格式或规范”。用户引用了站内内容,其中提到DoIP是基于以太网的通讯协议,用于传输UDS协议的数据,规范于ISO13400标准。关键点:-DoIP协议:DiagnosticcommunicationoverInternetProtocol-规范:ISO13400标准-数据格式:我需要提供关于DoIP数据格式的详细信息根据系统级指令:-所有行内数学表达式使用$...$格式-独立公式使用$$...$$格式并单独成段-LaTeX语法正确-使用中文回答-生成相关问题-回答中引用的段落末尾自然地添加引用标识-回答结构清晰,帮助用
recommend-type

JavaScript中文帮助手册:初学者实用指南

### JavaScript中文帮助手册知识点概述 #### 1. JavaScript简介 JavaScript是一种轻量级的编程语言,广泛用于网页开发。它能够增强用户与网页的交互性,使得网页内容变得动态和富有生气。JavaScript能够操纵网页中的HTML元素,响应用户事件,以及与后端服务器进行通信等。 #### 2. JavaScript基本语法 JavaScript的语法受到了Java和C语言的影响,包括变量声明、数据类型、运算符、控制语句等基础组成部分。以下为JavaScript中常见的基础知识点: - 变量:使用关键字`var`、`let`或`const`来声明变量,其中`let`和`const`是ES6新增的关键字,提供了块级作用域和不可变变量的概念。 - 数据类型:包括基本数据类型(字符串、数值、布尔、null和undefined)和复合数据类型(对象、数组和函数)。 - 运算符:包括算术运算符、关系运算符、逻辑运算符、位运算符等。 - 控制语句:条件判断语句(if...else、switch)、循环语句(for、while、do...while)等。 - 函数:是JavaScript中的基础,可以被看作是一段代码的集合,用于封装重复使用的代码逻辑。 #### 3. DOM操作 文档对象模型(DOM)是HTML和XML文档的编程接口。JavaScript可以通过DOM操作来读取、修改、添加或删除网页中的元素和内容。以下为DOM操作的基础知识点: - 获取元素:使用`getElementById()`、`getElementsByTagName()`等方法获取页面中的元素。 - 创建和添加元素:使用`document.createElement()`创建新元素,使用`appendChild()`或`insertBefore()`方法将元素添加到文档中。 - 修改和删除元素:通过访问元素的属性和方法,例如`innerHTML`、`textContent`、`removeChild()`等来修改或删除元素。 - 事件处理:为元素添加事件监听器,响应用户的点击、鼠标移动、键盘输入等行为。 #### 4. BOM操作 浏览器对象模型(BOM)提供了独立于内容而与浏览器窗口进行交互的对象和方法。以下是BOM操作的基础知识点: - window对象:代表了浏览器窗口本身,提供了许多属性和方法,如窗口大小调整、滚动、弹窗等。 - location对象:提供了当前URL信息的接口,可以用来获取URL、重定向页面等。 - history对象:提供了浏览器会话历史的接口,可以进行导航历史操作。 - screen对象:提供了屏幕信息的接口,包括屏幕的宽度、高度等。 #### 5. JavaScript事件 JavaScript事件是用户或浏览器自身执行的某些行为,如点击、页面加载、键盘按键、鼠标移动等。通过事件,JavaScript可以对这些行为进行响应。以下为事件处理的基础知识点: - 事件类型:包括鼠标事件、键盘事件、表单事件、窗口事件等。 - 事件监听:通过`addEventListener()`方法为元素添加事件监听器,规定当事件发生时所要执行的函数。 - 事件冒泡:事件从最深的节点开始,然后逐级向上传播到根节点。 - 事件捕获:事件从根节点开始,然后逐级向下传播到最深的节点。 #### 6. JavaScript高级特性 随着ECMAScript标准的演进,JavaScript引入了许多高级特性,这些特性包括但不限于: - 对象字面量增强:属性简写、方法简写、计算属性名等。 - 解构赋值:可以从数组或对象中提取数据,赋值给变量。 - 模板字符串:允许嵌入表达式。 - 异步编程:Promise、async/await等用于处理异步操作。 - 模块化:使用`import`和`export`关键字导入和导出模块。 - 类和模块:引入了`class`关键字,允许使用面向对象编程风格定义类,以及模块的声明。 #### 7. 开发工具和调试技巧 为了提高JavaScript开发效率和调试问题,以下是一些常用的工具和调试技巧: - 浏览器的开发者工具:包括控制台(Console)、元素查看器(Elements)、网络监控(Network)、源码编辑器(Sources)等。 - 断点调试:在源码编辑器中设置断点,逐步执行代码,查看变量值和程序流程。 - console.log:在控制台输出日志,帮助理解程序执行流程和变量状态。 - 使用JavaScript验证工具:如JSHint、ESLint等,可以在开发过程中进行代码质量检查。 以上就是《JavaScript中文帮助手册》中可能包含的主要知识点。作为初学者,通过这些内容可以系统地学习和掌握JavaScript基础和进阶知识,实现从初学到实践的跨越。在实际应用中,还需结合具体实例和项目练习,不断加深理解和熟练操作。
recommend-type

深入理解MySQL存储引擎:InnoDB与MyISAM的终极对决

# 1. MySQL存储引擎概述 MySQL数据库的灵活性和高性能在很大程度上得益于其存储引擎架构。**存储引擎**是MySQL中用于存储、索引、查询数据的底层软件模块。不同的存储引擎拥有不同的功能和特性,允许数据库管理员针对特定的应用需求选择最佳的存储引擎。例如,**InnoDB**提供事务支持和行级锁定,适用于需要ACID(原子