风力摆控制系统设计报告

合集下载

全国大学生电子设计竞赛B题风力摆设计报告

全国大学生电子设计竞赛B题风力摆设计报告

2015年全国大学生电子设计竞赛风力摆控制系统( B 题)2015 年8 月15 日本文以IAP单片机为控制核心,可以在运行过程中对User Flash的部分区域进行烧写;MPU605是陀螺仪与加速度传感器的结合,可实时检测出风力摆的状态并由单片机处理后通过PID控制算法实现闭环调节,实现对直流电机转速的控制以此来达到风力摆的动态平衡。

系统设计结构简单,制作成本低,控制精度高。

风力摆运行状态由液晶显示,智能性好,反应速度快,具有良好的人机交互界面。

目录一、系统方案 (1)1、电机的论证与选择12、单片机的论证与选择...............................................................13、电机驱动电路的论证与选择1二、系统理论分析与计算22.1保证系统稳定性的方法 (2)⑴选取合适的材料搭建支架 (2)(2)选取适宜的硬件提高精准度 (2)1、小型直流电机电路32、显示模块的电路33、电机驱动电路3三、系统设计31、系统流程图32、程序设计(见附录) ................................................................3四、测试方案及结果31、测试仪器32、测试结果33、测试分析 (5)五、结论与心得5六、参考文献5附录1 :源程序 (6)风力摆控制系统( B 题)【本科组】一、系统方案本系统主要由控制处理模块、角度,加速度检测模块、驱动模块、电源模块、显示组成,下面分别论证这几个模块的选择。

1、电机的论证与选择方案一:采用步进电机。

步进电机具有动态响应快、易于起停,易于正反转及变速的优点。

但缺点是它以步进式跟进,角度小于一个步距角时是系统响应盲区,而且经过测试步进电机在控制旋转臂时,抖动性大并且容易出现卡顿现象,所以不适合风力摆的控制。

方案二:采用小型轴流风机。

扭矩大,体积小,驱动电路简单,稳定强,负载能力强等优点。

风力摆的精确控制设计

风力摆的精确控制设计

风力摆的精确控制设计杜金祥;杜宇轩【摘要】Design a measurement and control system, control drive the fan makes wind pendulum movement according to certain rule, laser pen to draw the required path on the ground.This design by STM32F4 micro-processor,gyroscope, OLEDdisplay, human-computer interaction system, universal joint structure of closed-loop control system, etc. Gyro attitude algorithm, data for the system to provide the accurate PID control fan speed.In drive, using the pulse width control large current driver chipBTN7971 debugging technology, can very good to dc fan speed, direction and start-stop and other working condition for rapid, accurate control.The brush position control.LOD linear regulator was adopted in the power control chip, the power supply ripple is small, ensure the stable operationof the system.This system has realized the wind in the under the dc fan power control was only fast the pendulum, line drawing, restore the function of static, and accurately draw circle, and affected by the wind can quickly restore circle state, has the very good robustness.In addition, this system has good man-machine interface, the parameters and test mode is the key input and through the liquid crystal display, operation is simpleand convenient.%设计一测控系统,控制驱动各风机使风力摆按照一定规律运动,激光笔在地面画出要求的轨迹。

风力摆控制系统设计

风力摆控制系统设计

摘要:本次风力摆控制系统设计,采用4个直流风机垂直挂在长约70cm的细管下方,直流风机下方固定一个激光笔,当风力摆受控制按一定规律运动时,激光笔在地上画出相应的轨迹。

本设计以STC15W4K32S4系列的芯片作为主控芯片,采用LM298模块作电机驱动,通过单片机控制其输入占空比获得不同高低电平,达到对电机转速的控制。

空间角度测量中,本设计采用MPU-6050陀螺仪对空间角度进行准确追踪,精度高。

最终可将所测部分数据传输到LCD12864显示出来。

关键字:STC15W4K32S4单片机轴流风机陀螺仪一、设计任务设计一测控系统,控制驱动各风机使风力摆按照一定规律运动,激光笔在地面画出要求的轨迹。

1.基本要求(1)从静止开始,15s内控制风力摆做类似自由摆运动,使激光笔稳定地在地面画出一条长度不短于50cm的直线段,其线性度偏差不大于±2.5cm,并且具有较好的重复性;(2)从静止开始,15s内完成幅度可控的摆动,画出长度在30~60cm间可设置,长度偏差不大于±2.5cm的直线段,并且具有较好的重复性;(3)可设定摆动方向,风力摆从静止开始,15s内按照设置的方向(角度)摆动,画出不短于20cm的直线段;(4)将风力摆拉起一定角度(30°~60°)放开,5s内使风力摆制动达到静止状态。

2.发挥部分(1)以风力摆静止时激光笔的光点为圆心,驱动风力摆用激光笔在地面画圆,30s内需重复3次;圆半径可在15~35cm范围内设置,激光笔画出的轨迹应落在指定半径±2.5cm的圆环内;(2)在发挥部分(1)后继续作圆周运动,在距离风力摆1~2m距离内用一台50~60W台扇在水平方向吹向风力摆,台扇吹5s后停止,风力摆能够在5s内恢复发挥部分(1)规定的圆周运动,激光笔画出符合要求的轨迹;(3)其他。

二、方案论证基于本次风力摆控制系统的设计,我们有如下几种方案:方案一:采用传统的51单片机做主控芯片,其体积小,价格便宜,控制简单,但其运算速度慢,内部存储容量小,难以存储大体积的程序和实现快速精准的反应控制。

风摆控制实验系统设计

风摆控制实验系统设计

风摆控制实验系统设计余善恩;李真【摘要】The experimental system aims to meet the teaching and studying requirements ,which provides the experimental platform for learning the principle of automatic control ,MCU ,embedded system ,etc .The main research contents include design of angular surveying ,control & drive module ,and PC software .MPU6050 was used for angular surveying ,PID control algorithm was used to control the flap to go to the target angular , and PC software was used for display ,analysis ,and processing .%为满足"自动控制原理"实验教学的需要,研发了一套风摆控制实验系统.该系统分为角度检测模块、控制驱动模块、上位机软件3部分.控制驱动模块接收来自角度检测模块的风摆角度信息,与上位机设定的目标角度进行比较,计算出当前的风机驱动量并调节风机风力,将风摆控制到目标位置.该系统提供了一个综合性实验平台,能够灵活地应用于单片机、嵌入式系统、电机控制等课程.【期刊名称】《实验技术与管理》【年(卷),期】2017(034)006【总页数】4页(P135-138)【关键词】风摆;自动控制;PID控制;实验系统【作者】余善恩;李真【作者单位】杭州电子科技大学自动化学院 ,浙江杭州 310018;杭州电子科技大学自动化学院 ,浙江杭州 310018【正文语种】中文【中图分类】G642.423“自动控制原理”是自动化类专业本科生的重要专业课,也是其他院系本科生的专业基础课或选修课。

基于K60的风力摆控制系统设计

基于K60的风力摆控制系统设计

r e s u l t s s h o w t h a t t h i s d e s i g n c o r y o f w i n d p e n d u l u m i n r e a l t i me , w i t h t h e a d v a n t a g e s o f s ma l l o v e r s h o o t , s h o r t
wi t h DC f a n d r i v i n g mo d u l e, a n d a c a me r a p o s i t i o n i n g mo d u l e t o f o r m a c l o s e d l o o p c o n t r o l s y s t e m. T h e d i r e c t i v e i s i s s u e d b y a s i n g l e c h i p
s c r e e n t o r e a l i z e ma n—ma c h i n e i n t e r a c t i o n, t h e s t a t e a n d t h e mo v e me n t p a r a me t e r s c a n b e d i s p l a y e d b y t h e s c r e e n .T h e e x p e ime r n t a l
《自动化 与仪 器仪表1 2 0 1 6年第 l O期 ( 总第 2 0 4期 )
基于 K 6 0的风 力 摆控 制 系 统 设 计
宫 玉芳 , 赵 霞 , 杨 志飞
( 1 . 兰州交通 大学 电子 与信 息工 程学院 甘肃兰州 , 7 3 0 0 7 0 ) ; ( 2 . 兰州交通大学 自动化与 电气工程学 院 甘肃 兰州 , 7 3 0 0 7 0 )

风力摆的精确控制设计

风力摆的精确控制设计

对 风 力 摆 的 影 响 。 直 杆 选 用 了 玻 纤 管 。使 摆 更 轻 ,控 制 更 有 驱动 能力 强 ,加 速 性 能 ,减 速 性 能 好 效 率 高 的 特 点 。
灵 活 。
2-3 电机 选 择
轴 流 风 机 我 们 使 用 了整 体 重 量 很 轻 但 是 风 力 强 大 的 流
r58224

广
5 憾
{【 上G s I R S OvUsT 。7一 D13 [ 5 82D24"I rL 广—旦 VOSU T IS 蜒
470g ̄ BTN797 f5 82 2
BTN797
PWMl一2 … ,

图 2 BTN7971驱 动
4 系 统 软 件 设 计
采 用 小 型直 流 电机 。直 流 电 机 转速 快 。体 积 小 。具 有 最 优
风 机 ,与普 通 直 流 无 刷 流 风机 相 比大 大 缩 短 了完 成任 务 的 时 越 的调 速 性 能嘲,主 要 表 现 在 调 速 方 便 (可 无 级 调 速 )、运 行 平
间 。 流 风 机 的 固 定 架 是用 proe画 图 .经 3D打 印 机 打 印 而 成 稳 、噪 音 低 、效 率 高等 方 面 O
路 ,故 可 以直 接 和 MCU接 口 ,同时 具 有 电 流 检 测 ,以及 过 温 、 电 压 击 穿 开 关 管 。 电路 如 图 2所 示 。
f iND
PWM1—1

2 GND 1


3 I N
D1 motorl D2 GND IN 2

1d一0 ~ INH OUT 45 82 【

全国大学生电子设计竞赛B题风力摆设计报告精编版

全国大学生电子设计竞赛B题风力摆设计报告精编版

全国大学生电子设计竞赛B题风力摆设计报告公司内部编号:(GOOD-TMMT-MMUT-UUPTY-UUYY-DTTI-2015年全国大学生电子设计竞赛风力摆控制系统(B题)2015年8月15日摘要本文以 IAP 单片机为控制核心,可以在运行过程中对User Flash的部分区域进行烧写;MPU6050是陀螺仪与加速度传感器的结合,可实时检测出风力摆的状态并由单片机处理后通过PID 控制算法实现闭环调节,实现对直流电机转速的控制以此来达到风力摆的动态平衡。

系统设计结构简单,制作成本低,控制精度高。

风力摆运行状态由液晶显示,智能性好,反应速度快,具有良好的人机交互界面。

目录风力摆控制系统(B题)【本科组】一、系统方案本系统主要由控制处理模块、角度,加速度检测模块、驱动模块、电源模块、显示组成,下面分别论证这几个模块的选择。

1、电机的论证与选择方案一:采用步进电机。

步进电机具有动态响应快、易于起停,易于正反转及变速的优点。

但缺点是它以步进式跟进,角度小于一个步距角时是系统响应盲区,而且经过测试步进电机在控制旋转臂时,抖动性大并且容易出现卡顿现象,所以不适合风力摆的控制。

方案二:采用小型轴流风机。

扭矩大,体积小,驱动电路简单,稳定强,负载能力强等优点。

综合比较以上两种电机,结合设计所需平稳的控制摆杆处于竖直状态,故选择小型轴流风机。

2、单片机的论证与选择方案一:采用 AT89C52 单片机。

AT89C52 单片机是一种低功耗、高性能CMOS 8 位微控制器,具有 8K 在系统可编程 Flash 存储器。

方案二:采用IAP15F2K61S2 单片机。

IAP 系列单片机具有低功耗、高速度、超强抗干扰等优点。

方案三:采用 STC89C52RC 单片机本身带有有 8 路十位 AD 转换和 2 路PWM,而且处理速度比一般单片机要快,精度高。

综合比较以上三种单片机。

为了更方便、高精度、高速度地控制系统,完成题目要求,故选择 IAP15F2K61S2 单片机为主控芯片。

全国大学生电子设计竞赛设计报告风力摆

全国大学生电子设计竞赛设计报告风力摆

2015年全国大学生电子设计竞赛风力摆控制系统(B题)2015年8月15日摘要本风力摆系统主要包括单片机控制模块,开关电源(电源模块)激光笔及小型轴流风机,以及基于六轴倾角仪mpu6050的闭环控制系统。

其中控制模块采用STM32为核心控制芯片,激光笔作为系统的执行机构,12V2.5A的小型轴流风机作为驱动风力摆的唯一动力,用12V的开关电源驱动轴流风机。

轴流风机和摆杆通过万向节固定在支架上(用粗股导线将风力摆悬挂在支架上)。

固定在支架上,测量得到的角度经过软件处理得到风力摆摆动所需要的PWM值。

(本系统的PID 算法算法是通过实际经验试验出风力摆的控制规律,稳定的完成风力摆运动过程中激光笔画轨迹。

)关键词:风力摆; STM32; 轴流风机; PID算法; mpu6050目录一、系统结构方案与设计 (1)1、机械结构设计 (1)2、主控芯片的论证与选择 (1)3、风力摆结构方案的论证和选择 (2)4、运动控制算法的论证和选择 (2)二、系统理论分析与计算 (2)1、摆杆位置检测 (2)2、风力摆运动控制分析 (2)3、控制算法分析 (2)三、电路与程序设计 (3)1、电路的设计 (3)(1)STM32最小系统电路 (4)(2)稳压电源电路 (4)2、程序的设计 (4)(1)程序功能描述与设计思路 (4)(2)程序流程图 (4)四、测试方案与测试结果 (5)1、测试方案 (5)2、测试条件与仪器 (5)3、测试结果及分析 (5)(1)测试结果(数据) (5)(2)数据分析与结论 (7)五、结论与心得 (7)六、参考文献 (8)附录1:电路原理图 (9)附录2:源程序 (11)风力摆控制系统(B题)【本科组】一、系统结构方案与设计1、机械结构设计我们以生钢为材料加工成的十字作为风力摆支架的底盘,结构坚固克服摆动时的震动。

以实心的钢棒作为摆杆减小了摆动时的自旋,用万向节将摆杆和支架的水平臂连接保证了摆动的灵活性以及达到了摆动角度和速度的精确控制。

风力摆论文报告修订稿

风力摆论文报告修订稿

风力摆论文报告WEIHUA system office room 【WEIHUA 16H-WEIHUA WEIHUA8Q8-风力摆控制系统(B题)摘要本风力摆控制系统主要包括单片机控制模块,液晶显示模块,直流电机,驱动模块以及姿态检测模块构成闭环系统。

其中控制模块采用STM32F103为控制芯片,直流电机为执行机构,电子调速器为电机驱动。

MPU6050采集风力摆姿态角,MCU处理姿态角数据后通过PID算法调节直流风机以控制风力摆快速画直线、摆角度,恢复静止的功能,并能按照要求画圆,在受风力影响后能够快速恢复画圆状态。

另外本系统采用OLED显示屏实现了友善方便的人机交互界面。

关键词:STM32F103 MPU6050 PID算法电子调速器?1系统论证与比较系统基本方案本系统主要由主控制模块、姿态检测模块、液晶显示模块,电机驱动模块和悬挂模块四部分组成,实现了风力摆控制系统。

系统框图如图1所示。

图1 风力摆控制系统总体框图姿态检测方案的论证与选择方案一:倾角传感器。

倾角传感器运用牛顿第二定律,根据定律,当倾角传感器静止的时候,由于物体的侧面还有垂直方向是受到其他力的作用,只有重力的作用,也就是说作用在它身上的就只有重力加速度了,所以由此产生的重力垂直轴与加速度传感器灵敏轴之间的夹角,可以用来测量相对于水平面的倾角变化量,就是我们所说的倾斜角。

但是倾角传感器侧重于静态测量,不适合检测运动物体的角度变化。

方案二:MPU6050。

MPU6050六轴传感器集成3轴MEMS陀螺仪和三轴MEMS 加速度计,每个轴对应有一个16位AD转换器。

正常工作时,陀螺仪和加速度计分别采集X轴,Y轴,Z轴的电压值,然后通过AD转换,转换成数字信号,最后通过I2C总线传送到控制芯片,但此时得到的值不是实际的角度和角速度值,还必须经过一定的比例关系进行转换,才能得到实际的角度和角速度值。

该传感器整合了6轴运动处理组件,免除了组合陀螺仪与加速器时之轴间差的问题,减少了大量的封装空间。

风力摆控制系统方案

风力摆控制系统方案

风力摆控制系统方案简介风力摆控制系统是用来控制风力摆的运动的一种系统。

风力摆通常用于测量风力的强度和方向,以便在风能利用方面进行相应的调整和优化。

本文将介绍一个设计用于控制风力摆运动的系统方案。

目标本系统的目标是实现对风力摆的精确控制,使其可以随需要而停止、开始或改变方向。

通过控制风力摆的运动,可以提高其测量精度,并确保风能的高效利用。

系统组成本系统主要由下面几个组成部分构成:1. 风力摆风力摆是本系统的核心部件,它用于测量风向和风速。

风力摆通常由一个垂直铰接杆和一个悬挂在杆上的摆锤组成。

当风吹过摆锤时,摆锤会向相反方向摆动,从而使测量者能够通过观察摆动的幅度和方向来判断风的强度和方向。

2. 传感器为了实现对风力摆的控制,需要安装相应的传感器来检测风力摆的姿态和运动。

常用的传感器包括倾斜传感器和加速度传感器。

倾斜传感器用于检测风力摆的倾斜角度,而加速度传感器用于检测风力摆的加速度。

这些传感器可以提供给控制系统必要的数据,以便进行相应的控制。

3. 控制器控制器是系统中的核心部件,负责接收传感器的数据并根据设定的控制算法对风力摆进行控制。

控制器通常由微处理器或可编程逻辑控制器(PLC)组成,它可以根据需求改变风力摆的运动方向、幅度或停止风力摆的运动。

4. 电源与通信模块为了保证系统的正常运行,需要为系统提供稳定的电源。

另外,为了方便对系统进行监控和控制,还需要配备相应的通信模块,使得系统可以与外部设备进行数据传输和命令交互。

系统工作原理本系统工作的基本原理是通过控制器对风力摆进行精确控制。

控制器通过接收传感器提供的数据来判断当前风力摆的状态,并根据设定的控制算法采取相应的控制策略。

控制信号经过放大和处理后,通过执行机构控制风力摆的运动。

系统的工作流程如下:1.传感器采集风力摆的姿态和运动数据,并将数据传输给控制器。

2.控制器根据接收到的数据判断风力摆的状态,如姿态角度、加速度等。

3.控制器根据设定的控制算法,计算出相应的控制信号。

全国大学生电子设计竞赛B题风力摆设计报告

全国大学生电子设计竞赛B题风力摆设计报告

全国大学生电子设计竞赛B题风力摆设计报告公司标准化编码 [QQX96QT-XQQB89Q8-NQQJ6Q8-MQM9N]2015年全国大学生电子设计竞赛风力摆控制系统(B题)2015年8月15日摘要本文以 IAP 单片机为控制核心,可以在运行过程中对User Flash的部分区域进行烧写;MPU6050是陀螺仪与加速度传感器的结合,可实时检测出风力摆的状态并由单片机处理后通过PID 控制算法实现闭环调节,实现对直流电机转速的控制以此来达到风力摆的动态平衡。

系统设计结构简单,制作成本低,控制精度高。

风力摆运行状态由液晶显示,智能性好,反应速度快,具有良好的人机交互界面。

目录风力摆控制系统(B题)【本科组】一、系统方案本系统主要由控制处理模块、角度,加速度检测模块、驱动模块、电源模块、显示组成,下面分别论证这几个模块的选择。

1、电机的论证与选择方案一:采用步进电机。

步进电机具有动态响应快、易于起停,易于正反转及变速的优点。

但缺点是它以步进式跟进,角度小于一个步距角时是系统响应盲区,而且经过测试步进电机在控制旋转臂时,抖动性大并且容易出现卡顿现象,所以不适合风力摆的控制。

方案二:采用小型轴流风机。

扭矩大,体积小,驱动电路简单,稳定强,负载能力强等优点。

综合比较以上两种电机,结合设计所需平稳的控制摆杆处于竖直状态,故选择小型轴流风机。

2、单片机的论证与选择方案一:采用 AT89C52 单片机。

AT89C52 单片机是一种低功耗、高性能 CMOS 8 位微控制器,具有 8K 在系统可编程 Flash 存储器。

方案二:采用IAP15F2K61S2 单片机。

IAP 系列单片机具有低功耗、高速度、超强抗干扰等优点。

方案三:采用 STC89C52RC 单片机本身带有有 8 路十位 AD 转换和 2 路 PWM,而且处理速度比一般单片机要快,精度高。

综合比较以上三种单片机。

为了更方便、高精度、高速度地控制系统,完成题目要求,故选择 IAP15F2K61S2 单片机为主控芯片。

简易风力摆报告设计

简易风力摆报告设计

简易风力摆报告设计Company Document number:WUUT-WUUY-WBBGB-BWYTT-1982GT摘要设计了一个简易风力摆控制装置,由直流风机组,陀螺仪,直流减速电机以及激光笔等组成。

以MSP430F149单片机为核心,用PWM波控制控制电机转速,调节风力大小,并以四个风机上下与左右同面两两并在一起对碳素管及激光笔进行工作,使细杆及激光笔在风机的作用下可进行自由摆动且进一步可控摆动在地上划线,具有很好的重复性,并且可以设定摆动方向且画短线,已经能够在将风力摆拉起一定角度放开后可以在规定时间内达到平衡。

关键词:风力控制摆、陀螺仪、轴流风机、PWM调速、MSP430单片机风力摆控制系统(B题)1方案设计与选择设计内容要求一个下端悬挂有(2~4只)直流风机的细管上端固定在结构支架上,只由风机提供动力,构成一个风力摆,风力摆上安装一个向下的激光笔。

通过单片机代码指令控制驱动风机使风力摆按照一定的规律运动,并使激光笔在地面画出要求的轨迹,风力摆结构图如图1所示。

图1风力摆结构图设计要求基本要求(1)从静止开始,15s 内控制风力摆做类似自由摆运动,使激光笔稳定地在地面画出一条长度不短于50cm 的直线段,其线性度偏差不大于±,并且具有较好的重复性;(2)从静止开始,15s 内完成幅度可控的摆动,画出长度在30~60cm 间可设置,长度偏差不大于±的直线段,并且具有较好的重复性;(3)可设定摆动方向,风力摆从静止开始,15s 内按照设置的方向(角度)摆动,画出不短于20cm 的直线段;(4)将风力摆拉起一定角度(30~45°)放开,5s 内使风力摆制动达到静止状态。

发挥部分(1)以风力摆静止时激光笔的光点为圆心,驱动风力摆用激光笔在地面画圆,30s 内需重复3 次;圆半径可在15~35cm 范围内设置,激光笔画出的轨迹应落在指定半径±的圆环内;(2)在发挥部分(1)后继续作圆周运动,在距离风力摆1~2m 距离内用一台50~60W 台扇在水平方向吹向风力摆,台扇吹5s 后停止,风力摆能够在5s 内恢复发挥部分(1)规定的圆周运动,激光笔画出符合要求的轨迹;(3)其他。

风力摆智能控制系统设计

风力摆智能控制系统设计
出控制 。优 点是控制 精度高 , 调节速 度快 , 超调量 小 。
作者简介 : 王蓉晖( 1 9 7 2 - ) , 女, 吉林 长春人 , 吉林建筑大学 电气与计算机学 院教授 , 硕士 , 主要从事智能建筑中的节能控 制研究 。
第3 2卷
第1 0期
王蓉晖等: 风力摆智能控制系统设计
・ 1 0 7・
间 的通 信采 用 4 0 0 k H z的 I 2 C接 口 , 实现高速通信。
2 系统理论分析与计 算
2 . 1 系统机械 结构 的设 计
风力 摆通 过连杆 连接 在万 向接 头上 , 4个 轴 流风 机分 别 由 4路 独立 1 2 V 独立 电源 为 之 供 电 , 陀螺 仪 MP U 6 0 5 0安 装在 风力 摆 上 , 单 片 机 系统 板 固定 在 支 架臂 上 , 其 系 统机械 结构 设计 如 图 2所示 :
2 . 3 风 力摆 运动 控制 的分 析
/ i 1  ̄6 0 ∞ 0
轴流风机系统采用 T A 3 5 0 D C 1 2 V 2 . 3 A的轴流 风 机作 为驱 动 , 为实现对 风 力摆 的控 制 , 我们 需 要 检 测 到其 摆 动 的 实 时 状 态 。 当 MP U 6 0 5 0姿 态 传 感 器 采集数 据 后 , 单 片机 处 理 姿 态 角信 息 , 调节输 出 P WM 得 占空 比, 控 制 4个 轴 流 风 机 的工 作 状 态 , 已 达 到控制 风力 摆三 维姿 态 的 目的。
更 大风 力
收 稿 日期 : 2 0 1 6 — 0 8 . 1 7 基金项 目: 国家 安 全 生 产 监 督 管 理 总 局 ( 2 0 1 2 -1 2 6 ) 。

风力摆运动控制系统设计

风力摆运动控制系统设计
表 明: 风力摆 能够在 1 5 S 内, 完成设定的直线运动 , 轨迹误差小 于 ± O . 5 c m; 能够在 2 0 S 完成设定半径 的圆
周运动 , 轨迹能够在设定 半径 ±2 . 5 c m 的圆环 内。 关键词 :轴流风机 ; MP U 6 0 5 0 ; 运动控制
v a l u e a n d t r i g o n o me t r i c f u n c t i o n s c o mp u t a t i o n w i t h t wo i n d e p e n d e n t P I D a l g o r i t h m. T h e P I D a l g o r i t h m c a n ma k e
在三维空问的位 置 , 控制安装在摆杆底端的 4个 轴流风机 使得 风力 摆运动。在风力摆 正下端置一激光笔 ,
根据 MP U 6 0 5 0的反馈数值及三角 函数运算 , 运用两个独立 P I D算 法 , 控制风力摆做直线或 圆周 运动 , 且 在 圆周运动时使风力摆受到 5 0  ̄ 6 0 W 台扇在水 平方 向吹风 的干扰后 , 可以5 S内恢 复运动 轨迹。实验数 据
中图分 类号 :T P 2 7 2 文献标识 码 :A 文章编 号 :1 0 0 0 - - 9 7 8 7 ( 2 0 1 6 ) 1 2 - 0 1 0 6 - 0 4
De s i g n o f mo t i o n c o nt r o l s y s t e m f o r wi nd p e nd u l u m
风 力摆 运 动 控 制 系统 设 计
张 国军 ,李 绍明 ,闫孝妲 , 李 威 ,朱正 印
( 辽宁工程技术大学 电气与控制工程学院 , 辽 宁 葫芦 岛 1 2 5 1 0 5 ) 摘 要 :系统 以 3 2位 的 M K 6 0 D N 2 5 6 Z V L L 1 0单 片机 为核 心 , 通 过运 动处理传 感器 MP U 6 0 5 0测量 风力摆

风力摆控制系统

风力摆控制系统
方案 1:使用两个直流风机,直接将两个直流风机固定在摆杆的下方,两个 直流风机成十字交叉状如图 2.3 所示。这种方式的优点在于负载轻、操作简单, 可以直接由两个直流风机分别负责两个轴上的摆动,不过风力摆的状态微调和快 速制动不易实现。
摆杆
风机 1 风机 2
图 2.3 两个直流风机组合示意图
4
方案 2: 使用四个直流风机,用两个矩形塑料板组成十字形,分别将四个直 流风机放置在四个点上如图 2.4 所示。每个轴上由两个直流风机控制风力摆的摆 动,可以很好地做到加速摆动与快速制动,能够更容易的实现题目的要求。
(2) 在发挥部分(1)后继续作圆周运动,在距离风力摆 1~2m 距离内用 一台 50~60W 台扇在水平方向吹向风力摆,台扇吹 5s 后停止,风力摆能够在 5s 内恢复发挥部分(1)规定的圆周运动,激光笔画出符合要求的轨迹;
(3) 其他。
2 方案论证与设计
2.1 总体方案描述
本设计的结构示意主视图与俯视图如下图 2.1 所示,为了实现题目中的要求, 我们在初始点 O 处 1~4 号直流风机全部开始运转,1、3 号直流风机用来调节垂 直于运动方向上的距离,使其摆动时偏差不超过允许范围;2、4 号直流风机同时 运转,但转速不同,使风力摆向风速小的方向运动。风力摆无法直接运动到指定 位置,所以需要多次摆动,每次到达最高点时将其推向另一侧,最终使其实现摆 动。采用姿态采集模块来测量摆动角度,进而推断画线长度;通过几个在直流风 机的合力使风力摆向任意指定方向摆动;改变各个直流风机的风速使其尽快制动。 调节各个风机使其在有无干扰的情况下完成画圆功能。
方案 1:12864 液晶显示,12864 不仅能显示数字符号,还能显示汉字与图 形,操作方法与其他液晶显示相似。但其体积较大,并且价格较高。

风力摆控制系统

风力摆控制系统

风力摆控制系统(B 题)摘要:本系统为由 STM32 单片机控制模块、姿态采集模块、风力摆模块、液晶显示模块、人机交互系统以及风力摆机械结构组成的闭环控制系统。

MPU6050 采集风力摆姿态角,单片机处理姿态角数据后通过 PID 精确算法调节直流风机以控制风力摆。

本系统实现了风力摆在仅受直流风机为动力控制下快速起摆、画线、恢复静止的功能,并能准确画圆,且受风力影响后能够快速恢复画圆状态,具有很好的鲁棒性。

另外,本系统具有良好的人机交互界面,各参数及测试模式可由按键输入并通过液晶显示,智能性好,反应速度快。

关键词:PID 算法 MPU6050 STM32单片机人机交互1系统方案本风力摆控制系统主要包括单片机控制模块、电源模块、姿态采集模块、风力摆模块、液晶显示模块、人机交互系统以及风力摆机械结构组成。

风力摆由万向节连接碳杆再连接风机组成。

位于碳杆最下方的姿态采集模块不断采集风力摆当前姿态角,并返回单片机。

单片机控制液晶显示姿态角数据并处理数据后通过控制PWM 波占空比控制风机转速,实现对风力摆的控制。

本系统结构框图如图1所示。

图1 系统总计结构框图1.1处理器选择方案方案一:采用传统的51系列单片机。

传统的51单片机为8位机,价格便宜,控制简单,但是运算速度慢,片内资源少,存储容量小,难以存储大体积的程序和实现快速精准的反应控制。

并且受时钟限制,计时精度不高,外围电路也增加了系统的不可靠性。

方案二:采用以增强型80C51内核的STC系列单片机STC12C5A60S2,其片内集成了60KB程序Flash,2通道PWM、16位定时器等资源,操作也较为简单,具有在系统调试功能(ISD),开发环境非常容易搭建。

但实际使用了三维角度传感器等对速度要求较高的外设,因此无法很好地符合设计的需要。

方案三:采用以ARM Cortex-M3为内核的STM32F1系列控制芯片,STM32系列芯片时钟频率高达72MHz,具有64K字节SRAM,512K字节的FLASH容量,具有极强的处理计算能力。

风力摆控制系统

风力摆控制系统

【 关键 词 】 MS P 4 3 0 1 4 9 单 片机 ;角度传感器 ;万向节 ;直流轴风机
注意功耗 问题 、散热 问题 。
1 基本 要求
1 ) 从静 止开 始 ,l 5 s 内控制 风 力摆做 类 似 自由摆 运 动 ,使激光 笔稳定 地在地面 画 出一 条长度不 短于5 0 a m 的 直线段 ,其线性度偏差不大于 ±2 . 5 c m ,并且具 有较好 的
E L E C T R ONI C S WOR L D ・技 术 交 流
风力摆控制 系统
天津现代 职业技 术学院 王娜丽
【 摘 要 】本 系统主要  ̄MS P 4 3 0 — 1 4 9 单片机、轴流 电机 、万向节、陀螺仪 传感器、 电机 驱动 电路 、降压模块 。通过 开关
电源输 出1 2 V%源经过 降压模块 降压输 出3 . 3 V和5 V电压给驱动模块 ,由MS P 4 3 0 — 1 4 9 输 出P wM给 驱动电路 ,来控制风机 的转速 ,然后 通过 陀螺仪传 感器进行A D采集 ,进 而控 制蜂呜器 ,发 出响声 ,完成各 项任务 。
方案三 :N e w W a y 2 9 8 一 M 电机驱动模块是N e w w a y 电子精 心打造的一款 电机驱动器 ,它能够很方便的驱动2 路直流 电
2 . 2 模块方案论证
2 . 2 . 1 电 源模 块 ( 5 V)
方 案一 :采用7 8 0 5 ,7 8 0 5  ̄端稳 压I c 内部 电路具 有
本系 统 以4 3 0 单 片机作控 制器 , 由开关 电源产生 1 2 V 电源 ,经 过 降压 得到5 V 和3 . 3 V 的 电源对 风机驱动 电路进
行供 电,通过4 3 0 进 行输 出P W M 给驱动 电路控制 直流轴 风 机 ,风 机上 装陀螺仪 传感器 ,通过 陀螺仪 传感器 反馈信 息来调节P W M 进 行风机 的调节 ,最 后 进行调试 完成
  1. 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
  2. 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
  3. 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。

风力摆控制系统设计报告文件编码(008-TTIG-UTITD-GKBTT-PUUTI-WYTUI-8256)大学生电子设计竞赛风力摆控制系统学院: 计算机学院项目:风力摆控制系统负责人:王贤朝指导老师:张保定时间: 2017年5月20日摘要本系统采用K60开发板作为控制中心,与万向节、摆杆、直流风机(无刷电机+扇叶)、激光头、反馈装置一起构成摆杆运动状态与风机速度分配的双闭环调速系统。

单片机输出可变的PWM波给电机调速器,控制4个方向上风机的风速,从而产生大小不同的力。

利用加速度计模块MPU6050,准确测出摆杆移动的位置与中心点位置之间的关系,采样后反馈给单片机,使风机及时矫正,防止脱离运动轨迹。

使用指南针模块判别方向,控制系统向指定方向偏移。

控制方式采用PID算法,比例环节进行快速响应,积分环节实现无静差,微分环节减小超调,加快动态响应。

从而使该系统具有良好的性能,能很好地实现自由摆运动、快速制动静止、画圆、指定方向偏移,具有很好地稳定性。

关键词:K60、空心杯电机、MPU6050、PID、无线蓝牙目录风力摆控制系统(B题)【本科组】一、系统方案系统基本方案控制方案设计为了实现题目要求我们采用K60单片机做为主控芯片,用加速度计陀螺仪模块MPU6050来计算角度和风机状态,用直流风机带动摆杆运动。

当MPU6050检测到摆杆的角度时,可根据三角函数公式计算出摆杆现在距离中心的具体位置(方向、距离),单片机会控制PWM波的输出大小来控制风机的风速与方向,使摆杆达到在特定位置静止或按照一定的轨迹运动。

当摆杆处于自然下垂状态时,给四个风机同时上电且风向都向外,此时摆杆仍处于受力平衡——静止状态。

此时降低X轴上一个风机的转速,摆杆将会带动激光头在X轴上画一条直线,当达到一定的倾斜角度时,单片机可根据角度计算出此时距离中心的距离是否>=25cm,若达到要求后,此风机减速,X轴反方向上电机逐渐加速,恢复到初始速度,反方向做相同的运动。

在此过程中,单片机做出A/D采样,Y轴方向方向风机随时做出矫正,防止发生轨迹偏移。

机械结构方案设计由于摆杆长度(60cm~70cm)较长,且要求激光头在地面画出15cm~35cm的圆,所以要求横杆的距离要足够长。

横杆长度较长加之摆杆重量较大,所以要求底座要有足够的重量来支撑整个系统。

如果结构不稳或者重量不够,摆杆运动过程中将会产生倾倒或者抖动等现象,影响测试结果。

于是,底座采用了“工”型结构,保证了整个系统的稳定性。

摆杆材料方面,我们选用轻便的硬质铁质材料与风机进行刚性连接,既能保证连接处的稳定,又可达到减轻底座负担的目的。

风机选择方面,既要保证风力够大,能够实现题目基本要求中的自由摆运动、快速制动静止。

各部分方案选择与论证方案一:采用小型轴流风机(大功率),使用双滚珠轴承,采用滚动摩擦的形式,轴承中有数颗微小钢珠围绕轴心,当扇叶转动时,钢珠即跟着转动。

因为都是球体,摩擦力较小,所以转速较高。

能达到8000RMP,同时产生较大的风力。

风机内力矩较大,是因为机内绕了大量的铜线,导致重量较大,当4个风机固定到一起时,重量更大,风机产生的风力带动风机运动困难加大,更难做到题目中按要求运动。

另一方面,此风机功率较大,所需电流较大,驱动与供电方面也有很大问题。

方案二:采用双环强磁空心杯电机,内部使用强磁,转速较高。

风力也足够大,基本能达到要求。

方案三:采用无刷电机,风力较大,重量适中,完全能达到题目运动状态要求,速度控制精确,但须配套电机调速器。

综合考虑,我们选择方案二。

电机驱动的选择由于上述电机选择了空心杯电机,此驱动BTN7971B驱动芯片。

摆杆与横杆的连接选择方案一:摆杆使用粗单股导线直接与横杆连接,连接简单且自由度较好,给风机供电等方面都比较容易,但是导线容易产生自旋,风机固定困难也增大,增加了调试难度。

方案二:摆杆使用硬质碳素杆材料,通过万向轴与横杆相连。

用此材料强度能够达到要求,且风机固定容易。

硬件搭建合理,配重平衡的前提下,摆杆来回摆动不易发生偏移,可轻松解决基本要求(1),减少了编写代码的工作量。

综上考虑,我们选择方案二,节约时间。

摆杆与风机的连接选择方案一:摆杆与风机之间使用一个直流电机或者舵机连接,这样可以随时改变风机的方向,同时可减少风机的数量,控制量减少。

但是此方案连接结构较为复杂,发挥部分圆周运动稳定性不高。

方案二:摆杆与风机之间采用刚性连接,连接较为简单,稳定性能较好。

综上考虑,我们选择方案二。

二、系统理论分析与计算风力摆位置的计算与分析通过加速度计陀螺仪模块MPU6050检测风力摆摆杆的倾角数据。

MPU6050集成了3轴MEMS陀螺仪,3轴MEMS加速度计。

可根据三角函数公式,可计算出此时摆杆距离中心位置的距离(见图3)。

内部有一个数字运动处理器DMP。

测试过程中,MPU6050与单片机之间进行通信,距离较长,走线较多,干扰较大导致读数不准确,所以在SCL与SDA上拉2K电阻,解决采样问题。

内置卡尔曼滤波器,采用最优化自回归数据处理算法精确测量风力摆当前姿态角。

MPU6050对陀螺仪和加速度计分别采用了16位的ADC,将其测量的模拟量转化为可输出的数字量,通过DMP处理器读取测量数据然后通过串口输出。

12 MPU6050可测量出出θ1的角度由图中可知21πθα=+ 22πθα=+ 风力摆运动状态的分析 基本要求(1)中属于开环控制系统,激光笔绘制的轨迹超过50cm 即可。

我们可以设置摆杆倾角超过一个阈值θ,θ可通过摆动半径R (R>=25cm )直接计算出。

然后,通过开环调节,从低到高改变风机的风速,直到摆杆的角度超过阈值,记下此时PWM 波脉宽级作用时间。

要绘制50cm 直线,只需R>25cm (R 为地面运动轨迹的一半)在平面内运动即可a L R tan +=θ则)(aL R arctan +=θ其中L 为摆杆与激光头的长度,a 为激光头到地面的距离(a<=20cm )基本要求(2)摆动幅度可控,属于闭环控制系统,公式计算与(1)相同设置直线长度▽θ(30cm<▽θ<60cm )MPU6050将倾角,角速度送给单片机,单片机控制风机来产生推力使摆杆摆动。

控制算法的分析系统采用PID 算法来控制风机转动的速度,风机开始工作后,MPU6050不断采集当前摆杆摆脚状态,并与之前的状态进行比较,使得摆杆运动状态趋于稳定。

PID 算法控制器由4个风机速度分配比例P 角度误差积分I 角度微分D 组成。

图4 摆杆角度姿态分析切线方向所以θ1=θ2;根据三角函数式L d 2sin =θ (60cm<L<70cm) 可求出摆其输入e (t )与输出U (t)关系为:])(*)()(1)([*)(0⎰++=t dt t de D t d t e I t e P t U 他的传递函数为:在发挥部分(1)时,要求做圆周运动。

四个直流风机1、2、3、4,1和3用来使摆杆与重力方向呈现设置的夹角,2和4用来推动摆杆沿切线方向运动,这样通过控制1、3电机的PID 参数使摆杆达到设定的角度,通过2和4推动摆杆,摆杆就会沿切线运动,绘制圆形轨迹。

三、电路与程序设计电路的设计系统整体使用K60控制芯片,使用手机或者电脑通过蓝牙进行演示控制,MPU6050陀螺仪控制方向角度。

电源系统整体采用电池电源供电,电压是,空心杯电机平均所需电流为,电源可满足需求。

供给4个并联电机驱动(电调)带动风机转动,5V 给单片机供电,单片机自带稳压输出给MPU6050供电,电机驱动本身也可稳压输出5V ,给激光头(供电。

程序的设计1、程序功能描述系统采用蓝牙模块控制,可通过手机或者电脑就行指令输入,令风力摆作出相应的反应。

2、程序设计思路 图5 圆周运动分析图选基本要求(1)属于全开环控制,通过粗略控制便可实现,设定倾角阈值,从低到高不断增加X风机转速,直到倾角超过阈值,记录此时PWM脉宽级作用时间。

基本要求(2)需要采用闭环控制算法,计算公式与(1)相同,设定好范围后,可与(1)使用相同的方法调试。

基本要求(3)要采用受力分析,使用力的合成。

基本要求(4)拉起一定角度后,如果不提供动力,摆杆将逐渐衰减,但是速度缓慢,因此需要提供与运动方向相反的力,阻碍摆杆运动。

这个过程需要注意,实时采集摆杆的角度(比例项 P),进行微分从而确定角速度(陀螺仪直接测量亦可),为微分项D,采用类似于自平衡的PD 控制算法即可发挥部分(1)可以明确,径向风机控制采用 PID 控制算法,使摆杆稳定在某一设定角度,切线方向控制 2、4电机产生推力,推动摆杆圆周运动。

那么,很明显,关键在于如何使摆杆稳定在某一个角度(认为设定),使用PID 算法即可,原理类似于基本部分(4),只不过基本部分(4)将竖直方向(重力方向)视为设定值,而发挥部分中是将设定的半径转换成的角度视为设定值。

发挥部分(2)这个项目主要是评价发挥部分(1)控制算法的稳定性,无需特别的算法,事实上只要发挥部分(1)做得好,这一部分即可实现。

发挥部分(3)使用了指南针模块,可以确定方向,无论将系统怎么放置,摆杆可始终指向一个指定的方向。

1、PID算法框图四、测试方案与测试结果测试方案(1)驱动风机带动摆杆来回摆动,使激光头在地面上打出一条大于50cm的直线。

记录由平衡位置到完成划线要求时所用的时间以及最大偏差距离。

重复6次,记录在表1中。

图11 PID算法框图(2)人为的设定激光头划线的长度,从30cm开始测量,记录到达规定长度所用时间和最大误差,测量3次,时间取平均值。

然后依次记录40cm、50cm、60cm的数据,记录在表2中。

(3)人为的设定激光头划线的方向,使激光头在地面上打出一条大于20cm 的直线。

从0°直线开始。

记录达到规定长度所用时间和最大误差,测量3次,时间取平均值。

然后依次测量90°、180°、270°、360°直线,记录在表3中。

(4)将摆杆拉倒一定的角度然后放下,驱动风机,记录摆杆恢复到中心位置所用时间,记录在表4。

(5)以摆杆静止时的位置为圆心,设置画圆半径,记录激光头划线旋转3周后所用时间,以及偏差的最大距离,重复3次。

然后改变半径长度,在一次测量,记录在表5中。

(6)加入外界台扇干扰后,依次测量记录恢复到(5)状态所用时间,记录在表5中。

测试条件与仪器秒表、自制角度测量板、量角器、直尺、示波器。

测试结果及分析(1)测试结果表1 风力摆画长于50cm 直线测试表4 风力摆恢复静止测试表5 风力摆画圆测试(2)测试分析与结论根据上述测试数据,该风力摆控制系统已能达到基本部分和发挥部分的全部要求和性能指标,由此可以得出以下结论:1.风机的性能是决定系统能否完成题目要求的关键,风机性能由其本身决定,包括重量、产生的最大风速、以及所需的电流。

相关文档
最新文档