2022年风力摆控制系统 .pdf

《2022年风力摆控制系统 .pdf》由会员分享，可在线阅读，更多相关《2022年风力摆控制系统 .pdf（16页珍藏版）》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。

1、1 风力摆控制系统摘 要本设计实现了用风力作为动力的摆动装置控制系统，该系统是由单片机控制模块、姿态采集模块、风力摆模块、显示模块、独立按键以及风力摆机械结构组成的。 本设计采用了 MSP430F149为单片机控制直流风机； 电子陀螺仪 MPU6050采集风力摆姿态角；独立按键来切换各个工作状态；激光笔来显示摆动的轨迹；LED 灯显示运动是否达到要求。 本设计实现了风力摆做直线摆动， 且摆动长度、角度可设定； 快速制动； 在有无干扰的情况下画圆的要求，本系统较好的完成了题目所给的指标。关键词： 风力摆；直流风机；MSP430F149；电子陀螺仪 名师资料总结 - - -精品资料欢迎下载 - -

2、 - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 1 页，共 16 页 - - - - - - - - - 2 1 设计任务与要求1.1 设计任务一长约 60cm70cm 的细管上端用万向节固定在支架上， 下方悬挂一组（24 只）直流风机，构成一风力摆，如图1 所示。风力摆上安装一向下的激光笔，静止时，激光笔的下端距地面不超过20cm。设计一测控系统，控制驱动各风机使风力摆按照一定规律运动，激光笔在地面画出要求的轨迹。图 1.1 风力摆结构示意1.2 设计要求1.2.1 基本要求（1） 从静止开始， 15s 内控制风力摆做类似自由摆

3、运动，使激光笔稳定地在地面画出一条长度不短于50cm 的直线段，其线性度偏差不大于2.5cm，并且具有较好的重复性；（2） 从静止开始， 15s 内完成幅度可控的摆动， 画出长度在3060cm 间可设置，长度偏差不大于2.5cm 的直线段，并且具有较好的重复性；（3） 可设定摆动方向， 风力摆从静止开始， 15s 内按照设置的方向 （角度）摆动，画出不短于20cm 的直线段；（4） 将风力摆拉起一定角度（ 3045）放开，5s 内使风力摆制动达到静止状态。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - -

4、- - - - 第 2 页，共 16 页 - - - - - - - - - 3 1.2.2 发挥部分（1） 以风力摆静止时激光笔的光点为圆心，驱动风力摆用激光笔在地面画圆，30s 内需重复3 次；圆半径可在1535cm 范围内设置，激光笔画出的轨迹应落在指定半径 2.5cm 的圆环内；（2） 在发挥部分（ 1）后继续作圆周运动，在距离风力摆12m 距离内用一台 5060W 台扇在水平方向吹向风力摆，台扇吹5s 后停止，风力摆能够在5s 内恢复发挥部分（ 1）规定的圆周运动，激光笔画出符合要求的轨迹；（3） 其他。2 方案论证与设计2.1 总体方案描述本设计的结构示意主视图与俯视图如下图2.1

5、所示， 为了实现题目中的要求，我们在初始点 O 处 14 号直流风机全部开始运转，1、3 号直流风机用来调节垂直于运动方向上的距离， 使其摆动时偏差不超过允许范围；2、4 号直流风机同时运转，但转速不同， 使风力摆向风速小的方向运动。风力摆无法直接运动到指定位置，所以需要多次摆动， 每次到达最高点时将其推向另一侧，最终使其实现摆动。采用姿态采集模块来测量摆动角度，进而推断画线长度； 通过几个在直流风机的合力使风力摆向任意指定方向摆动；改变各个直流风机的风速使其尽快制动。调节各个风机使其在有无干扰的情况下完成画圆功能。图 2.1 结构示意主视图与俯视图根据上述描述，本系统设计系统框图如图2.2

6、所示，分为单片机控制、姿态采集、直流风机三大模块。 本系统采用姿态采集模块对角度进行测量，采用单片机采集数据， 并对电机驱动模块进行控制，进而控制直流风机。 本系统可以通过独立按键切换工作模式。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 3 页，共 16 页 - - - - - - - - - 4 图 2.2 系统框图2.2 微处理器模块的比较和论证方案 1：51系列单片机，是 8 位单片机，体积小，低功耗，控制能力强，扩展灵活，使用方便。但是其运行速度很慢， （因为是 CISC

7、 （集中指令）结构，而且芯片为了抗干扰采用了12 分频的方法）、所有的 I/0 口都是准双向口，I/0口的驱动能力弱。 方案 2：MSP430F149 单片机，是 16 位单片机，处理能力强，超低功耗，并且运算速度快。本设计需要多个电机轮流控制， 并对时间精度要求高，MSP430F149能够满足要求。 因为 MSP430F149 运算速度足够快，能够实现题目要求，相比较之下选择方案 2。2.3 直流风机组合方式的比较和论证方案 1：使用两个直流风机，直接将两个直流风机固定在摆杆的下方，两个直流风机成十字交叉状如图2.3 所示。这种方式的优点在于负载轻、操作简单，可以直接由两个直流风机分别负责两

8、个轴上的摆动，不过风力摆的状态微调和快速制动不易实现。图 2.3 两个直流风机组合示意图单 片 机姿 态 采 集 模 块电 源 模 块电 机 驱 动 模 块独 立 按 键激 光 笔显 示 模 块直 流 风 机风机 1 风机 2摆杆 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 4 页，共 16 页 - - - - - - - - - 5 方案 2： 使用四个直流风机， 用两个矩形塑料板组成十字形，分别将四个直流风机放置在四个点上如图2.4 所示。每个轴上由两个直流风机控制风力摆的摆

9、动，可以很好地做到加速摆动与快速制动，能够更容易的实现题目的要求。图 2.4 四个直流风机组合示意图综上所述，因为四个直流风机的组合更容易摆动与快速制动，所以选择方案2。2.4 姿态采集模块的比较和论证方案 1：采用倾角传感器ADXL345 ，感应倾斜偏差角度的，将数据反馈给单片机。操作简单、编程较容易、成本低，但其误差较大， 不能满足本设计要求。方案 2：采用电子陀螺仪MPU6050 测量角度。 MPU6050 是全球首例整合 3轴加速度计和 3 轴陀螺仪的 6 轴模块。内置 16 位的 A/D，输出 16 位的数据。测量范围可以根据需要进行选择，控制简单、方便。倾角传感器的误差较大，不能满

10、足设计要求，相比较之下选择方案2。2.5 液晶显示模块的比较和论证方案 1：12864 液晶显示， 12864 不仅能显示数字符号，还能显示汉字与图形，操作方法与其他液晶显示相似。但其体积较大，并且价格较高。方案 2：采用 1602 液晶显示， 1602 能显示字母、数字、符号，功能上完全满足此系统的要求。相比于12864，价格更低，更适合本设计。综上所述两个液晶显示模块都能满足设计要求，但 12864的价格较贵， 所以选择方案 2。风机 1 风机 2风机 3风机 4名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理

11、- - - - - - - 第 5 页，共 16 页 - - - - - - - - - 6 3 理论分析与计算3.1 摆动原理如图 3.1 为风力摆摆动受力分析图， A、 B 两点为摆动最高点， 以 A 点为例，=0，风力摆受到摆杆的拉力、重力 G，此时加速度如公式（ 3-1） ，因为 A 点为最高点，则此时角度为最大值，所以此时加速度a最大。若在此时风机全速运转，给风力摆施加与加速度a 方向相同的力 F，更容易使其加速，最终实现摆动。B 点同理。a =(3-1) 图 3.1 风力摆摆动受力分析图在用激光笔画设定长度的直线时，根据设定长度CD 与已知长度 MN，可求得其角度，计算公式如式（3

12、-2） 。采用陀螺仪检测角度，当角度达到时，则激光笔所画直线已达到设定长度。 = arc tan(3-2) 3.2PID 控制原理本设计采用 PID 算法来控制风力摆的摆动， 使用陀螺仪实时测量当前姿态，用其与前一个姿态、 前前一个姿态进行比较， 观察其变化趋势， 若变化趋势是远离设定姿态， 则调节直流风机， 以改变风力摆的变化趋势， 使风力摆的状态趋于设定姿态。 PID 算法输入与输出的关系如式（3-3）u(t) =( ) +(3-3) G F O N A B MCa D 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精

13、心整理 - - - - - - - 第 6 页，共 16 页 - - - - - - - - - 7 传递函数如式（ 3-4）G(s) =+(3-4) 比例 P： 对风力摆的角速度进行比例调节， 进而对直流风机的转速进行调节。比例越大，直流风机的转速越大，风力摆的角速度越大。不过不能过大，否则会造成超调。积分 I：对角度误差进行积分调节，消除系统的稳定误差。本设计对风力摆达到稳定状态的速度要求较高，所以对角度误差的积分调节要求不高。微分 D：微分调节反映风力摆的角度变化率，即角速度。微分调节具有预见性，可以预见偏差的变化趋势，进而超前控制系统。可以减小调节时间。4 系统硬件、软件的实现4.1

14、硬件实现4.1.1 微处理器电路本作品用的 MSP430F149最小系统电路如图4.1 所示。图 4.1 MSP430F149最小系统电路图名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 7 页，共 16 页 - - - - - - - - - 8 4.1.2姿态采集模块电路本设计采用了MPU6050 陀螺仪进行姿态采集， MPU6050 通过处理器读取测量角度然后通过串口输出，免去了用户自己去开发MPU6050 复杂的C 协议，同时精心的PCB 布局和工艺保证了MPU6050 收到

15、外接的干扰最小，测量的精度最高。模块内部自带电压稳定电路， 可以兼容3.3V/5V 的嵌入式系统，连接方便。模块保留了MPU6050 的C接口，以满足高级用户希望访问底层测量数据的需求。采用先进的数字滤波技术，能有效降低测量噪声，提高测量精度。模块内部集成了姿态解算器， 配合动态卡尔曼滤波算法， 能够在动态环境下准确输出模块的当前姿态， 姿态测量精度0.01 度，稳定性极高。 MPU6050 角度测量电路图如图 4.5 所示。图 4.2 MPU6050 角度测量电路图4.1.3 电机驱动电路L298N 电机驱动电路图如图4.3 所示， L298N 是 ST 公司生产的一种高电压、大电流电机驱动

16、芯片。该芯片采用15 脚封装。主要特点是：工作电压高，最高工作电压可达46V；输出电流大，瞬间峰值电流可达3A，持续工作电流为2A；额定功率 25W。内含两个 H 桥的高电压大电流全桥式驱动器，可以用来驱动直流电动机和步进电动机、 继电器线圈等感性负载； 采用标准逻辑电平信号控制；具有两个使能控制端， 在不受输入信号影响的情况下允许或禁止器件工作有一个逻辑电源输入端， 使内部逻辑电路部分在低电压下工作； 可以外接检测电阻，将变化量反馈给控制电路。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - -

17、 - 第 8 页，共 16 页 - - - - - - - - - 9 图 4.3 电机驱动电路图4.1.4 液晶显示模块电路本设计采用了 LCD1602 液晶显示模块，其电路图如图4.4 所示。液晶显示的原理是利用液晶的物理特性， 通过电压对其显示区域进行控制， 有电就有显示，这样即可以显示出图形。 液晶显示器具有厚度薄、 适用于大规模集成电路直接驱动、易于实现全彩色显示的特点。图 4.4 LCD1602电路图名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 9 页，共 16 页 -

18、 - - - - - - - - 10 4.2 软件实现4.2.1 主程序流程图本设计的主程序流程图如图4.3 所示，本系统使用单片机为主控核心，采用C 语言编程，使用软件读取风力摆角速度，加速度，倾斜角度等信息。它控制整个系统稳定协调的运作， 完成不同轨迹的绘制。 系统各种功能主要通过在中断中调用具体的子函数来实现。图 4.3 主程序流程图开始系统初始化起摆画直线是否进行功能设置读取键值是否读取键值分析指令执行功能执行结束名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 10 页，共

19、 16 页 - - - - - - - - - 11 4.2.2 子程序流程图图 4.4 画圆程序流程图图 4.5 画线程序流程图图 4.6 设置摆动方向程序流程图图 4.7 键盘读值程序流程图是否开始驱动电机画圆反馈圆的半径调节圆半径是否退出画圆结束是否开始驱动电机画线反馈线长调节电机是否退出画线结束是否开始设置摆动方向驱动电机摆动调节摆动是否退出结束开始定时中断扫描按键保存键值返回名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 11 页，共 16 页 - - - - - - -

20、- - 12 5 系统测试5.1 测试仪器表 5.1 测试仪器序号仪器名称备注1 秒表测量摆动时间2 直尺测量摆动长度与误差3 量角器测量角度4 方向角度图纸判断摆动方向与距离5 台扇外界干扰5.2 测试方案与结果5.2.1 风力摆画长于50cm 直线测试风力摆从静止开始做类似自由摆运动，激光笔在地面上画出运动轨迹， 直至画出一条长于 50cm 的直线，记录所用时间，在测量误差时多测3 个周期，取每个周期偏差的最大值，再计算三次的误差平均值，记录误差平均值，重复三次，测试结果如下表：表 5.2 风力摆画长于50cm 直线测试序号时间误差平均值1 9.45s 1.57cm 2 9.20s 1.8

21、0cm 3 9.34 1.97 经测试发现本设计可以在15s内摆动幅度达到 50cm 长，不过在摆动过程中有误差，这些误差是由于摆锤的结构做得不够完美，运动时方向会有偏差， 并且会受到外界风力等因素影响， 不过这些误差在可允许范围内， 能够满足题目要求。5.2.2 风力摆画不同长度直线测试设置风力摆画线长度， 风力摆从静止开始摆动， 激光笔在地面上画出运动轨迹，直至画出一条近似于指定长度的直线，记录所用时间，在测量误差时多测3个周期， 取每个周期偏差的最大值， 再计算三次的误差平均值， 记录误差平均值，设置不同长度重复三次，测试结果如下。名师资料总结 - - -精品资料欢迎下载 - - - -

22、 - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 12 页，共 16 页 - - - - - - - - - 13 表 5.3 风力摆画不同长度直线测试设置长度 (cm) 时间误差平均值30 7.34s 1.77cm 40 6.42s 1.57cm 50 7.81s 1.54cm 经测试发现本设计可以在15s内使风力摆摆动达到指定长度， 不过此长度有误差， 因为本设计在实现设定摆动长度时是根据角度与长度的关系确定设定的摆动角度，采用陀螺仪测量摆动角度， 可是陀螺仪在测量角度时会有误差，所以最终摆动的长度也会有误差，不过这些误差在可允许范围内

23、，能够满足题目要求。5.2.3 风力摆画不同角度直线测试设置风力摆自由摆时角度， 风力摆从静止开始按照规定角度摆动，激光笔在地面上画出运动轨迹，直至画出一条不小于20cm 的直线，记录所用时间，设置不同角度重复两次，测试结果如表5.4。表 5.4 风力摆画不同角度直线测试设置角度 ( ) 时间0 3.55s 90 4.12s 经测试发现本设计可以在15s内使风力摆摆动达到指定长度， 能够满足题目要求。5.2.4 风力摆恢复静止测试将摆锤拉至一定角度， 放手使其自由摆动， 同时开始计时， 由四个直流风机来使其静止，记录从放手开始到静止的时间。测试结果如下：表 5.5 风力摆恢复静止测试序号时间1

24、 7.36s 2 5.12s 3 8.14s 经测试发现本设计可以使风力摆静止。5.2.5 风力摆画圆测试设置风力摆做圆周运动时的半径，风力摆从静止开始摆动并开始计时，激光笔在地面上画出运动轨迹， 直至风力摆做圆周运动， 激光笔画出圆形， 并重复三名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 13 页，共 16 页 - - - - - - - - - 14 次，记录所用时间，在测量误差时多测3 个周期，取每个周期偏差的最大值，再计算三次的误差平均值，记录误差平均值，测试结果如表5.

25、6 所示。表 5.6 风力摆画圆测试序号所用时间误差平均值1 12.62s 1.54cm 2 12.45s 1.23cm 3 16.48s 1.37cm 经测试发现本设计可以在30s时间内从静止开始做圆周运动并重复三次，不过在做圆周运动时距离与设置半径有偏差，因为半径的检测使用陀螺仪实现的，而陀螺仪测量有误差， 而且在各个直流风机变速时会对圆周运动有影响。不过这些误差在可允许范围内，能够满足题目要求。5.2.6 风力摆抗干扰画圆测试完成画圆测试后，在距离摆锤12m 出放置一台 5060w的台扇水平方向的吹风力摆，吹 5s 停止，并开始计时，直到风力摆再次完成画圆测试时停止计时，记录时间。并根据

26、激光笔所画出的圆形计算平均误差，测试结果如下：表 5.7 风力摆抗干扰画圆测试序号所用时间误差平均值1 6.34s 0.83cm 2 7.81s 2.27cm 3 4.96s 1.80cm 经测试发现本设计可以在由台扇干扰后再次完成画圆测试，时间略长，轨迹的误差在允许范围内。5.3 误差分析完成所有功能的测试后发现， 出现误差的主要原因在于陀螺仪的测量不够准确，不过这是不可避免的， 在器件选择时此误差就被考虑在内。除此之外外界风力、直流风机变速等都有可能造成误差，不过经过我们的多次调试， 最终误差大多数被调试到允许范围内，基本能够满足题目要求。名师资料总结 - - -精品资料欢迎下载 - -

27、- - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 14 页，共 16 页 - - - - - - - - - 15 6 总 结经过四天三夜的努力， 本组较好的完成了题目的基础部分与发挥部分。风力摆能够从静止开始15s内做直线摆动，且长度超过50cm；在 3060cm间做可设置的直线摆动； 按照设定角度在 15s内做长度不小于 20cm 的直线摆动；在 5s内快速制动。 本设计还较好的完成了发挥部分的任务要求，在 30s内完成半径可设置的画圆操作并重复三次； 在有台扇干扰后能够继续做画圆操作。本设计较好的完成了各项指标。名师资料总结 -

28、 - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 15 页，共 16 页 - - - - - - - - - 16 参考文献1 张希等 .MSP430系列单片机使用 C 语言程序设计 .人民邮电出版社 ,2004.1 2 朱力恒电子技术仿真实验教程北京：电子工业出版社，2003.7 3 李琼瑞 .国外最新应用电路设计精选M. 电子工业出版社 ,2000.7 4 张洪润等 .单片机原理及应用 M. 清华大学出版社 ,1999.1 5 黄争著 .德州仪器高性能单片机和模拟器件在高校中的应用和选型指南.上海

29、:德州仪器半导体技术（上海）有限公司大学计划部,2010. 6 全国大学生电子设计竞赛组委会.全国大学生电子设计竞赛获奖作品选编M. 北京理工大学出版社 , 7 谢楷,赵建.MSP430系列单片机系统工程设计与实践.北京：机械工业出版社，2009.7. 8 王兆安,李进军 .电力电子技术 .北京：机械工业出版社，2009.5. 9梁明理 .电子线路（第五版） M. 北京：高等教育出版社，2008. 10张友德 、赵志英、涂时亮 .单片微型机原理、应用与实践（第五版）M. 上海：复旦大学出版社， 2009 11 童诗白 ,华程英 .模拟电子技术基础（第四版）M. 北京:高等教育出版社,2009. 12 黄智伟 ,王彦,陈文光等 .全国大学生电子设计竞赛训练教程M. 北京:电子工业出版社 ,2007. 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 16 页，共 16 页 - - - - - - - - -