2022年风力摆控制系统设计 .pdf
( 4.5 )《2022年风力摆控制系统设计 .pdf》由会员分享，可在线阅读，更多相关《2022年风力摆控制系统设计 .pdf（37页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。
1、摘要：本次风力摆控制系统设计，采用4 个直流风机垂直挂在长约70cm 的细管下方，直流风机下方固定一个激光笔，当风力摆受控制按一定规律运动时，激光笔在地上画出相应的轨迹。 本设计以 STC15W4K32S4 系列的芯片作为主控芯片，采用 LM298 模块作电机驱动，通过单片机控制其输入占空比获得不同高低电平，达到对电机转速的控制。 空间角度测量中， 本设计采用 MPU-6050 陀螺仪对空间角度进行准确追踪，精度高。最终可将所测部分数据传输到LCD12864 显示出来。关键字： STC15W4K32S4 单片机轴流风机陀螺仪名师资料总结 - - -精品资料欢迎下载 - - - - - - -
2、- - - - - - - - - - - 名师精心整理 - - - - - - - 第 1 页，共 37 页 - - - - - - - - - 一、设计任务设计一测控系统 ， 控制驱动各风机使风力摆按照一定规律运动， 激光笔在地面画出要求的轨迹。1. 基本要求（1）从静止开始， 15s 内控制风力摆做类似自由摆运动，使激光笔稳定地在地面画出一条长度不短于50cm 的直线段，其线性度偏差不大于2.5cm，并且具有较好的重复性；（2）从静止开始， 15s 内完成幅度可控的摆动，画出长度在3060cm间可设置，长度偏差不大于2.5cm 的直线段，并且具有较好的重复性；（3）可设定摆动方向，风力摆
3、从静止开始，15s内按照设置的方向（角度）摆动，画出不短于20cm 的直线段；（4）将风力摆拉起一定角度(30 60 )放开， 5s内使风力摆制动达到静止状态。2. 发挥部分（1）以风力摆静止时激光笔的光点为圆心，驱动风力摆用激光笔在地面画圆，30s内需重复 3 次；圆半径可在1535cm范围内设置，激光笔画出的轨迹应落在指定半径 2.5cm的圆环内；（2）在发挥部分（ 1）后继续作圆周运动，在距离风力摆12m 距离内用一台 5060W 台扇在水平方向吹向风力摆，台扇吹5s 后停止，风力摆能够在5s内恢复发挥部分（ 1）规定的圆周运动，激光笔画出符合要求的轨迹；（3）其他。二、方案论证基于本次
4、风力摆控制系统的设计，我们有如下几种方案：方案一：采用传统的51 单片机做主控芯片，其体积小，价格便宜，控制简单，但其运算速度慢， 内部存储容量小， 难以存储大体积的程序和实现快速精准的反应控制。其采用的是12MHz 时钟，受其限制，计时精度低，且其内部资源少，不适合本次需要多路PWM 控制电机转速，且精度和运算速度要求高的设计。方案二：采用 STC15W4K32S4 系列的单片机作主控芯片，控制PWM 脉宽调制从 I/O 口输出不同占空比的脉冲，经滤波后获得不同高低电平控制电机，从而达到控制电机转速的效果。 该系列芯片可控制多路PWM 脉宽调制， 且具有大容量4K 字节 SRAM ，内部有时
5、钟电路和复位电路，不需要外接，减轻了外围电路的复杂性，且其运算速率高， 精度大，适于控制精度和速率要求大的陀螺仪等模块。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 2 页，共 37 页 - - - - - - - - - 方案三：采用 STC15W4K32S4 系列单片机作主控芯片，通过D/A 变换电路将数字量转换成控制电机电压的模拟量。再利用电平的高低达到调速的目的。本方案达到了利用 CPU 输出的数字量精确控制模拟量的目的。但D/A 变换电路复杂，且整体设计成本较高。经过以上
6、分析，我们发现方案二电路设计相对简单，且控制速率快，精度高，成本低，考虑到这些，我们选择该方案进行设计。其流程框图如下：图 1 流程框图三、理论分析与计算3.1 设计原理本系统硬件主要有陀螺仪传感、四个轴流风机、 电源供电模块、 摆杆及支架构成。 STC15W4K32S4 作为系统的控制核心，陀螺仪传感器对摆杆的运行状态数据进行实时采集并反馈回单片机， 产生的控制量作用于电路从而实现对四个轴流风机转速及转向的控制。四个轴流风机产生空气推力进而实现对摆杆的控制。硬件框图如下图 2 所示。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - -
7、- 名师精心整理 - - - - - - - 第 3 页，共 37 页 - - - - - - - - - 图 2 硬件结构3.2 理论分析1.STC15W4K32S4 系列芯片本次主控芯片采用STC15W4K32S4 系列芯片，该芯片运行速度较传统的单片机快， ISP编程时 5MHz35MHz 宽范围可设置，可彻底省掉外部昂贵的晶振和复位电路， 省去了普通单片机制作最小系统时外部电路的设计。此外，该系列单片机具有大容量程序存储器，且内部资源丰富，具有8 路 10 位 PWM，8 路高速 10 位 A/D 转换， 4 组独立的高速异步串行通信端口SPI，是宽电压、高速、高可靠、低功耗、超强抗干
8、扰的新一代8051 单片机。STC15W4K32S4系列单片机如下图3 所示：其中包含中央处理器（CPU） 、程序存储器（ Flash） 、数据存储器（ SRAM） 、定时器 /计数器、掉电唤醒专用定时器、I/O 口、高速 A/D 转换、比较器、看门狗、 UART 高速异步串行通信口1、串行口 2、串行口 3、串行口 4、CCP/PWM/PCA、高速同步串行通信串口SPI、片内高精度 R/C 时钟及高可靠复位等模块。STC15W4K32S4 系列单片机几乎包含了数据采集和控制中所需要的所有单元模块，是一个真正的片上系统。名师资料总结 - - -精品资料欢迎下载 - - - - - - - -
9、- - - - - - - - - - 名师精心整理 - - - - - - - 第 4 页，共 37 页 - - - - - - - - - 图 3 STC15W4K32S4 系列单片机2.电机速度控制本次设计的电机驱动模块采用LM298 来驱动 4 个风机的转速，通过PWM脉冲宽度调制来调节电机的转速。LM298 内部包含 4 通道逻辑驱动电路，是一种二相和四相电机的专用驱动器。内部含有两个H 桥的高电压大电流双全桥式驱动器，接收标准TTL 逻辑电平信号，可驱动 46V，2A 以下电机。具有控制原理简单，输出波动小，线性好，对邻近电路干扰小等特点。PWM 即脉冲宽度调制技术，通过改变接通脉
10、冲宽度，使直流电机电枢上的电压的“占空比”改变，从而改变电枢电压的平均值，控制电机的转速。占空比定义：输出的PWM 中，高电平保持的时间与该PWM 的时钟周期的时间之比。该调速系统具有以下特点：（1）电路简单， 所用功率原件少， 且工作于开关状态， 因此电路的导通损耗小，装置效率比较高。（2）采用功率较小的低惯量电机时，具有高的定位速度和精度。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 5 页，共 37 页 - - - - - - - - - （3）低速性能好，稳速精度高，调速范
11、围宽。（4）系统频带宽，动态响应好，抗干扰能力强。3.MPU-6050 模块本设计采用高精度的陀螺加速度计MPU-6050，通过处理器读取 MPU-6050 的测量数据然后通过串口输出，免去了用户自己去开发MPU-6050 复杂的 I2C 协议，同时精心的 PCB 布局和工艺保证了MPU-6050 收到外接的干扰最小，测量的精度最高。模块内部自带电压稳定电路，可以兼容3.3V/5V 的嵌入式系统，连接方便。模块保留了 MPU-6050 的 I2C 接口，以满足高级用户希望访问底层测量数据的需求，采用先进的数字滤波技术，能有效降低测量噪声，提高测量精度。模块内部集成了姿态解算器，配合动态卡尔曼滤
12、波算法，能够在动态环境下准确输出模块的当前姿态，姿态测量精度0.01 度，稳定性极高，性能甚至优于某些专业的倾角仪！MPU-6050 模块连接上位机可输出加速度、角速度以及角度，其中加速度计算公式为：a x =(AxH8)|AxL)/32768*16g(g 为重力加速度，可取9.8m/s2) a y =(AyH8)|AyL)/32768*16g(g 为重力加速度，可取9.8m/s2) a z =(AzH8)|AzL)/32768*16g(g 为重力加速度，可取9.8m/s2) 其温度计算公式：T=(TH8)|TL) /340+36.53 其校验和：Sum=0 x55+0 x51+AxH+AxL
13、+AyH+AyL+AzH+AzL+TH+TL 角速度计算公式为：w x =(wxH8)|wxL)/32768*2000(/s) w y =(wyH8)|wyL)/32768*2000(/s) w z =(wzH8)|wzL)/32768*2000(/s) 其温度计算公式：T=(TH8)|TL) /340+36.53 其校验和：Sum=0 x55+0 x52+wxH+wxL+wyH+wyL+wzH+wzL+TH+TL 角度计算公式为：滚转角（ x 轴） ：Roll=(RollH8)|RollL)/32768*180() 俯仰角（ y 轴） ：Pitch=(PitchH8)|PitchL)/327
14、68*180() 偏航角（ z 轴） ：名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 6 页，共 37 页 - - - - - - - - - Yaw=(YawH8)|YawL)/32768*180() 温度计算公式：T=(TH8)|TL) /340+36.53 校验和：Sum=0 x55+0 x53+RollH+RollL+PitchH+PitchL+YawH+YawL+TH+TL 四、测试结果与误差分析4.1 测试使用工具及仪器（1）秒表（2）量角器（3）自制角度图纸4.2 测
15、试方案及结果4.2.1驱动风力摆工作，使激光笔稳定地在地面画出一条长度不短于50cm 的直线段，来回五次，记录其由静止开始至摆到规定长度时自由摆所用时间及最大偏差距离。测试结果如表1 所示。表 1 风力摆画长于50cm 直线测试第一次测量第二次测量第三次测量第四次测量第五次测量偏差距离 ( cm) 1.6 0.5 0.8 0.7 0.9 所用时间 ( s)13.7 11.3 12.6 10.4 14.7 4.2.2设定不同的长度， 驱动风力摆工作， 使其画出规定长度的线段， 记录其由静止开始自由摆动至画出规定长度的线段时所用的时间及在画不同长度线段时的最大偏差距离。测试结果如表2 所示。表 2
16、 风力摆画不同长度直线测试设定测量距离（cm）30405060偏差距离（ cm）0.8 1.2 0.6 1.6 所用时间（ s）10.8 12.8 12.2 13.4 4.2.3设置风力摆自由摆时角度， 驱动风力摆工作， 记录其由静止至开始自由摆时间及在画不同角度直线时的最大偏差距离。测试结果如表3 所示。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 7 页，共 37 页 - - - - - - - - - 表 3 风力摆画不同角度直线测试设定摆动角度画 0 直线画 90 直线画
17、180 直线画 270 直线画 360 直线偏差距离（ cm） 1.2 0.8 1.6 1.4 1.3 所用时间（ s） 12.4 10.8 13.2 11.6 13.8 4.2.4将风力摆拉起一定角度放开， 驱动风力摆工作， 测试风力摆制动达到静止状态所用时间。测试结果如表4 所示。表 4 风力摆恢复静止测试第一次测量第二次测量第三次测量第四次测量第五次测量拉起 304.8s 4.2s 4.6s 4.3s 4.7s 拉起 35 4.7s 4.6s 4.2s 4.5s 4.6s 拉起 40 4.4s 4.9s 4.7s 4.6s 4.2s 拉起 45 4.1s 4.4s 4.8s 4.7s 4
18、.2s 五、结论、心得体会本次设计中，利用 STC15 系列单片的低功耗、低价格以及资源丰富等特性，用其来作主控芯片使整个设计从成本、实现难易方面都符合实际要求。 在角度及电机转速控制过程中，更是利用MPU-6050 以及 LM298 使整个设计达到运行精度高，高速控制等优点。但由于时间紧张，还有一些问题没能较好解决，没有时间进一步改善。通过这次竞赛使我们明白了理论知识与实践相结合的重要性，理论知识最终是为实践服务的， 只掌握理论知识是远远不够的， 只有把理论知识与实际应用相结合，在理论中运算，在实践中得到结果，从而不但加深了对理论知识的理解，也提高了自己实际动手能力与独立思考能力。此外，本次
19、比赛中， 我们充分发挥了团队协作的精神， 懂得了在团队中分工合作的重要性，为以后的比赛甚至是学习工作取得很大的帮助。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 8 页，共 37 页 - - - - - - - - - 附录：总电路图原件清单源程序元件名称数量元件名称数量STC15W4K32S4 1 个轴流风机4 个变压器1 个12864液晶屏1 个升压模块2 个滑动变阻器若干MPU6050 模块1 个杜邦线若干电容若干Led 灯1 个电阻若干万用板2 个底座1 个LM298 电机
20、驱动1 个名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 9 页，共 37 页 - - - - - - - - - 原程序#includeSTC15Fxxxx.H #includeGPIO.h #includeUSART.h #includedelay.h #includetimer.h extern u8 PWM1; extern u8 PWM2; extern u8 PWM3; extern u8 PWM4; extern u8 TLY; extern u8 JY; extern
21、 float JD_num3; extern float J_SD_num3; extern u16 TIME_num; xdata float Z_sin17=7.5,7.8,8.0,8.9,9.5,9.9,10.0,10.5,11.0,11.5,12.0,12.5,13.0,13.5,13.9,14.0,15.0; u8 ge,shi,bai; int zhanbi; sbit PWM_R=P00; sbit PWM_L=P01; sbit PWM_H=P02; sbit PWM_Q=P03; void gongnengA() PWM_Q=1; delay_ms(200); delay_m
22、s(200); delay_ms(200); delay_ms(200); / delay_ms(200); / delay_ms(200); / delay_ms(200); 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 10 页，共 37 页 - - - - - - - - - / delay_ms(200); / delay_ms(200); / delay_ms(200); / delay_ms(200); / delay_ms(200); PWM_Q=0; /delay_
23、ms(10); PWM_H=1; delay_ms(200); delay_ms(200); delay_ms(200); delay_ms(200); / delay_ms(200); / delay_ms(100); / delay_ms(200); PWM_H=0; /delay_ms(100); /delay_ms(150); PWM_Q=1; delay_ms(200); delay_ms(200); delay_ms(200); delay_ms(200); delay_ms(200); / delay_ms(200); / delay_ms(200); / delay_ms(20
24、0); PWM_Q=0; delay_ms(100); /delay_ms(200); PWM_H=1; delay_ms(200); delay_ms(200); delay_ms(200); delay_ms(200); /delay_ms(200); /delay_ms(100); /delay_ms(200); PWM_H=0; PWM_Q=1; delay_ms(200); delay_ms(200); delay_ms(200); delay_ms(200); 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心
25、整理 - - - - - - - 第 11 页，共 37 页 - - - - - - - - - /delay_ms(200); /delay_ms(200); /delay_ms(200); PWM_Q=0; PWM_H=1; delay_ms(200); delay_ms(200); delay_ms(200); delay_ms(200); delay_ms(200); /delay_ms(100); /delay_ms(200); PWM_H=0; PWM_Q=1; delay_ms(200); delay_ms(200); delay_ms(200); delay_ms(200);
- 配套讲稿：
如PPT文件的首页显示word图标，表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制：
部分文档作品中含有的国旗、国徽等图片，仅作为作品整体效果示例展示，禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词：
- 2022年风力摆控制系统设计 2022 风力 控制系统 设计
淘文阁 - 分享文档赚钱的网站所有资源均是用户自行上传分享，仅供网友学习交流，未经上传用户书面授权，请勿作他用。
限制150内