基于STM32F103风力摆控制系统设计.docVIP

基于STM32F103风力摆控制系统设计 　　摘要： 本系统采用STM32F103单片机为核心控制系统，采用模块化设计方案，整个系统包含控制系统模块、电机驱动模块、角位移传感器模块、电源模块等。用角位移传感器MPU6050采集风力摆摆头的角度及位置，通过I2C总线传输发送到主控系统中，采用LCD12864显示采集到的信息，通过PID算法进行数据处理，产生相应的PWM信号，发送给相应的直流风机，控制直流风机实现自由摆动，从而画出直线、圆等轨迹。测试结果表明，该系统运算速度快，抗干扰能力强。 　　关键词： 风力摆； 角位移传感器MPU6050； PID算法 　　中图分类号：TP273 　　文献标志码：A 　　文章编号：2095-2163（2017）04-0076-03 　　0引言 　　风力摆系统是一个典型非线性、不稳定的系统。在经典控制理论和现代控制理论中的应用也是该领域具有代表性的基础研究课题之一。而将其作为实验装置时可以测试控制理论，检验控制方法和思路。这些控制研究成果都能广泛应用于一般工业与工程控制，所以对于风力摆控制系统的研讨设计则将呈现重要的理论探索意义和实际应用价值。本文即针对这一项目内容给出如下分析论述。 　　1系统硬件设计 　　1.1控制器模块比较与选择 　　1）方案一：采用STC89C51单片机作为控制器。STC89C51价格低廉，结构简单，且资料丰富；但是51单片机系统资源有限，8位控制器，运算能力有限，无法达到较高的精度，需要外接大量外围电路，增加了系统复杂度，达不到系统要求。 　　2）方案二：采用MSP430G2553单片机作为系统控制器。MSP430G2553单片机内部集成精度高，是16位单片机，但其外部接口较少，运算速度相对较慢，达不到要求。 　　3）方案三：采用STM32F103单片机作为系统控制器。STM32F103单片机是32位单片机，内部集成度高，拥有大量外部接口，运算速度高，能够满足问题中对数据的快速采集和处理需求。 　　综合以上3种方案，研究中选择方案三中的STM32F103单片机。 　　1.2角度传感器模块比较与选择 　　1）方案一：采用编码器根据脉冲数计算出角度，但是编码器体积较大，安装不方便，有突变现象，容易导致计算错误，故不能满足题目要求。 　　2）方案二：采用ENC陀螺仪，ENC陀螺仪能输出一个和角速度成正比的模拟电压信号，响应速度快，驱动电压和功耗较低。但是容易发生温漂，噪声较大，稳定性较差。 　　3）方案三：采用MPU6050三维角度传感器，MPU6050集成了3轴陀螺仪，3轴加速度计，以及一个可扩展的数字运动处理器DMP，可输出数字量，稳定性极佳，测量精度高。 　　综合比较以上方案，研究中选择方案三中的MPU6050传感器作为系统的角度传感器。 　　1.3驱动模块的比较与选择 　　1）方案一：采用L298驱动，L298是专用驱动集成电路，属于H桥集成电路，内部包含4通道逻辑驱动电路。但其输出电流不能超过4A，比较容易发热，不能符合题目的较大电流。 　　2）方案二：采用互补硅功率达林顿管驱动，采用该方法电路连接比较简单，稳定性好，成本低廉，但不足之处是由于使用分立元件，反应速度较慢，不能符合题目对轴流风机快速反应的要求。 　　3）方案三：采用电子调速器驱动，可根据控制信号调节电动机的转速，操作方便，具有过温、过压、欠压、过流及短路保护的功能。具有极好的驱动能力，反应灵敏，能够很好地满足题目的要求。 　　综合以上3种方案，研究中选择方案三中的电子调速器驱动。至此可得，系统整体框图如图1所示。 　　2控制原理 　　PID控制算法中，微分作用是控制器的输出与偏差变化的速度成比例，能对克服对象的容量滞后有显著效果，在比例基础上加入微分作用，使稳定性提高，再加上积分作用，可以消除余差，因此PID控制算法适用于控制质量要求很高的控制系统。使用PWM（脉宽调制）方法，可以方便地改变加给电机电枢的平均电压的大小。改变控制信号的占空比就可以改变电机的转速。具体分析如下： 　　error=set_angle-anggle_one[JY]（1） 　　其中，error为摆杆的角度差，set_angle对应摆杆平衡时的角度值，anggle_one对应摆杆当前的角度值。在此基础上，可进一步得到： 　　up=kp×error[JY] （2） 　　其中， kp为比例调节系数，通过公式可以看出，增大kp即可增强角度差的作用，从而提升系统的强硬速度，使摆杆迅速达到直立的状态。由此，研究求得ud的?笛П硎鋈缦拢? 　　ud=kd×（angleone-anggle_one_old）[JY]（3） 　　其中，anggle_one_old对应摆杆上一次采集到