风力摆控制系统论文设计.doc

《风力摆控制系统论文设计.doc》由会员上传分享，免费在线阅读，更多相关内容在行业资料-天天文库。

1、风力摆控制系统摘要：本系统采用STM32F103ZET6单片机作为控制核心，通过对置于风力摆上的MPU9150陀螺仪采集的角度进行处理得到角度与风力摆位置的关系，再通过驱动输出PWM波控制轴流风机，使风力摆到达指定的位置，做规定的圆周运动。本系统通过PID调试，测试表明，各项功能已达到或超过本题目要求。关键词：MPU9150；PID；轴流风机1.系统方案本系统主要由主控制器，陀螺仪，电机驱动模块，轴流风机，激光笔组成，下面分别对这几个模块进行选择与论证。1.1陀螺仪的选择方案一：MPU6050。9轴运动处理传感器，

2、它集成了3轴MEMS陀螺仪，3轴MEMS加速度计，以及一个可扩展的数字数字运动处理器DMP，可用I2C接口连接一个第三方的数字传感器，比如磁力计。MPU-6050对陀螺仪和加速度计分别用了三个16位的ADC，将其测量的模拟量转化为可输出的数字量。一个片上1024字节的FIFO，有助于降低系统功耗。但零飘较严重。方案二：角度传感器。当连结到RCX上时，轴每转过1/16圈，角度传感器就会计数一次。往一个方向转动时，计数增加，转动方向改变时，计数减少。计数与角度传感器的初始位置有关。当初始化角度传感器时，它的计数值被设置

3、为0。角度传感器一般测静态的角度，倾角用加速度计。明显在本系统中角度传感器不如陀螺仪方便使用。方案三：MPU9150。MPU-9150是采用系统级封装(SiP)，集合了两个芯片：MPU-6050和3轴数字罗盘AK8975，其中MPU-6050包含3轴陀螺仪、3轴加速计以及能够处理复杂9轴MotionFusion算法的板载DigitalMotionProcessor™(DMP™)。这款元件集成9轴MotionFusion算法，能够访问所有部传感器，以收集全套传感器数据。MPU9150测转角的速度的，可以积分得到转的角

4、度，动态性能好，静态差，零飘基本无，很适合本系统。综合考虑后决定采用方案三。1.2轴流风机的选择方案一：四线可测速、包含温控PWM调速轴流风机。此种轴流风机一般重量较大，启动时间长，虽然风量大但明显不适合本系统的实时检测调整的思路。方案二：三线可测速轴流风机。此种轴流风机重量较轻，启动时间短，直接接驱动即可对其进行控速，风量也很大，比较符合题目各项要求的时间限制。综合考虑后决定采用方案二。1.3轴流风机个数与方位选择方案一：两个轴流风机。两个轴流风机的摆放有两种方式，背对摆放和呈直角摆放。第一种方式只有两个方向的摆

5、角，而垂直摆放则只有180°的摆角。方案二：三个轴流风机。三个轴流风机呈等边三角形摆放，虽360°都可以达到，但是每两个轴流风机的夹角是钝角，合成后的力大大减小。方案三：四个轴流风机。四个轴流风机两两垂直摆放，合力方向遍布360°，且合力的方向方便计算，合力的大小方便控制。综合考虑后选择方案三。1.4电机驱动的选择方案一：ULN2003电机驱动模块。高耐压、大电流复合晶体管IC—ULN2003，ULN2003是高耐压、大电流复合晶体管阵列，由七个硅NPN复合晶体管组成。ULN2003工作电压高，工作电流大，灌电流可

6、达500mA，并且能够在关态时承受50V的电压，输出还可以在高负载电流并行运行。ULN2003电机驱动模块电路简单，既可控制直流电机又可控制步进电机。由于电流的限制，只能驱动小型电机。方案二：可实现电机正反转及调速,启动性能好，启动转矩大,工作电压可达到36V，可持续工作电流2A,此题中可同时驱动两台直流电机。TLP521-4光隔，L298N有过电流保护功能，当出现电机卡死时，可以保护电路和电机等。含两个H桥的高电压大电流全桥式驱动器，板载5V线性电源输出，纹波小，对单片机毫无干扰。综合考虑轴流风机的工作电流，决定

7、采用方案二。1.系统理论分析与计算2.1PID的原理与运用PID即比例、积分和微分，比例单元（P）、积分单元（I）和微分单元（D）组成。其输入e(t）与输出u(t）的关系为：u(t)=kp[e(t)+1/TI∫e(t)dt+TD*de(t)/dt]积分的上下限分别是0和t因此它的传递函数为：G(s)=U(s)/E(s)=kp[1+1/(TI*s)+TD*s]其中kp为比例系数；TI为积分时间常数；TD为微分时间常数。本系统中只用到了P和D，即比例和微分。陀螺仪的读出的角度传递给PID公式，PID公式计算后算出PWM

8、值对电机进行调节。Pitch的返回值对3、4号电机进行调节，roll的返回值对1、2号电机进行调节，这样就可以实现风力摆的360°的摆动。2.2风力摆系统与其空间模型风力摆的实际模型如图一所示，其建立的空间模型竖直截面如图二所示，横向截面如图三所示，风力摆空间模型如图四所示。图一图二如图二所示，根据直角公式可以得出h、θ与r之间的关系：，又结构一定时，已知h