2015全国大学生电子设计竞赛风力摆控制系统论文

2015年全国大学生电子设计竞赛风力摆控制系统（B题）2015年8月15日I摘要系统为由STC12单片机控制模块、姿态采集模块、风力摆模块、液晶显示模块、人机交互系统以及风力摆机械结构组成的闭环控制系统。MPU6050采集风力摆的姿态角，单片机处理姿态角数据后通过PID精确算法调节直流风机以控制风力摆。本系统实现了风力摆在仅受直流风机为动力控制下快速起摆、画线、恢复静止的功能，并能准确画圆，且受风力影响后能够快速的恢复画圆状态，具有很好的鲁棒性，另外，本系统具有良好的人机交互界面，各参数及测试模式可有按键并通过液晶显示，性能好，反应速度快。关键词：PID算法MPU6050STC12单片机人机交互II目录一、系统方案........................................................11.1主控制器件的论证与选择.......................................11.2姿势采集的论证与选择.......................................1二、系统理论分析与计算..............................................22.1风力摆控制系统的分析.......................................22.2、基础部分功能实现的分析与计算...............................32.2.1基础一功能实现的分析与计算.............................32.3、发挥部分功能实现的分析与计算...............................4三、电路与程序设计..................................................53.1电路的设计...................................................53.2基础部分系统框图与电路原理图...............................53.2.1基础部分系统框图.......................................53.3发挥部分系统框图与电路原理图................................63.3.1系统框图...............................................63.4电源........................................................63.5程序的设计..................................................63.5.1程序功能描述与设计思路.................................63.5.2程序流程图............................................6四、测量方案与测量结果..............................................74.1测量工具....................................................74.2测试方案及结果..............................................7五、结论与心得......................................................8六、参考文献........................................................9附录1：电路原理图.................................................10附录2：源程序（部分）.............................................111风力摆控制系统（B题）【本科组】一、系统方案本系统主要由STC12单片机控制模块、姿态采集模块、风力摆模块、液晶显示模块、电源模块组成，下面分别论证这几个模块的选择。1．1、主控制器件的论证与选择1.1.1单片机比较控制器选用方案一：采用传统的51系列单片机传统的51单片机为8位机，价格便宜，控制简单，但是运算速度慢，片内资源少，存储容量小，难以存储大体积的程序和实现快速精准的反应控制。并且受时钟限制，计时精度不高，外围电路也增加了系统的不可靠性。方案二：采用以增强型80C51内核的STC系列单片机STC12C5A60S2，其片内集成了60KB程序Flash，2通道PWM、16位定时器等资源，操作也较为简单，具有在系统调试功能（ISD），开发环境非常容易搭建通过比较，我们选择方案二，采用以增强型80C51内核的STC系列单片机STC12C5A60S2作为控制器。1.1.2控制系统方案选择方案一：采用在面包板上搭建简易单片机系统在面包板上搭建单片机系统可以方便的对硬件做随时修改，也易于搭建，但是系统连线较多，不仅相互干扰，使电路杂乱无章，而且系统可靠性低，不适合本系统使用。方案二：自制单片机印刷电路板自制印刷电路实现较为困难，实现周期长，此外也会花费较多的时间，影响整体设计进程。不宜采用该方案。方案三：采用单片机最小系统。单片机最小系统包含了显示、矩阵键盘、A/D、D/A等模块，能明显减少外围电路的设计，降低系统设计的难度，非常适合本系统的设计。综合以上三种方案，选择方案三。1.2、姿势采集的论证与选择方案一：只测量风力摆关于静止状态时的偏转角。采用二维平面内角位移传感器测量风力摆转动时关于静止状态时的偏转角，通过控制该偏转角实现对流风机的控制。该方案软件处理繁琐，且二维平面内的角位移传感器不利于测量风力摆的空间位置，不利于实现对风力摆的精确控制。方案二：选用双轴倾角传感器模块LE-60-OEMLE-60-OEM，测量重力加速度变化，转为倾角变化，可测量双向。具有稳定性高、低功耗、结构简单等优点。响应速度为5Hz。它可以测量平衡板与水平方向的夹角，x,y方向可以测，但z轴不可测。且操作复杂，软件处理难度大。方案三：采用三维角度传感器。用三维角度传感器时刻测量风力摆当前姿态，通过处理采集的姿态角数据控制风机带动风力摆运动。此方案可精确测量风力摆当前姿态，实现对风力摆的精确控制。综合比较以上两个方案，本系统选择方案三。21.3、控制系统的论证与选择1.3.1风机速度控制方案一：采用D/A变换电路将数字量转换成控制电机电压的模拟量。再利用电平的高低达到调速的目的。原理框图如图1所示。本方案达到了利用CPU输出的数字量精确控制模拟量的目的。但原电路比较复杂，成本较高。方案二：采用脉宽调制方式（PWM）从I/O口输出不同占空比的脉冲，经滤波后获得不同高低电平控制电机。本方案可以达到对速度的控制要求，且控制简单易实现。通过比较明显方案二最简洁清晰、容易实现、速度快、精度高。从系统指标要求来看，对速度要求较高，低速与高速之间差别较大，且准确度要求高，各个速度之间的切换也要求简单、迅速。采用方案二可利用单片机运行速度快的特点进行速度的快速调整，且方案二速度准确度高、级数多容易达到系统指标要求。所以我们选用方案二作为控制部分具体实施的方案。1.3.2算法的选择方案一、采用模糊控制算法,模糊控制有许多良好的特性,它不需要事先知道对象的数学模型,具有系统响应快、超调小、过渡过程时间短等优点，但编程复杂，数据处理量大。方案二、采用PID算法，按比例、积分、微分的函数关系,进行运算,将其运算结果用以输出控制。优点是控制精度高,且算法简单明了。对于本系统的控制已足够精确，节约了单片机的资源和运算时间。综合比较以上两个方案，本系统选择方案二。二、系统理论分析与计算2.1、风力摆控制系统的分析2.1.1风力摆系统模型建立（1）建立风力摆运动模型，由于系统是由轻杆和风机等组成，相较于风机，轻杆质量很小，可以近似认为旋转臂重心在风机中心线上附近，风机沿半径为L的弧长自由摆动。示意图如图图.1自由摆模型示意图①
最低位置时风机将达到最大速度，因此在不计空气阻力及固定点摩擦力的下利3用能量守恒定律有：lvmmg2)θcos1(,在θ不超过60°，l=70cm的情况下。计算得v=2.236m/s，由角速度与线速度之间的关系，得出slv/128②自由摆周期计算根据单摆的周期计算公式gLT2；得单摆周期T=1.732ms。2．2、基础部分功能实现的分析与计算2.2.1基础一功能实现的分析与计算如图2：图2系统结构图要绘制超过50cm的直线段，只需要在平面内运动即可，如上图所示，只需要R大于25cm，有公式：21tanLLR;则)arctan(21LLR其中，R为横向摆动半长，1L为摆杆长，2L为激光笔长(2L可忽略不计)。2.2.2基础二功能实现的分析与计算要实现任意设置的线段长度，相当于需要实现指定范围内任意的角度，必须使用闭环控制，否则很难实现精确控制。计算公式和基本部分（1）一样，不过，我们需要增加闭环控制算法，详述如下：设置任意直线段长度（30~60cm间）∆R,那么，对应的摆杆最大角度（角度阈值）为)arctan(21LLR。如此转换便可得到我们能够测量的物理量（倾角）传感器将倾角,角速度返回MCU，MCU通过控制轴流风机产生空气推力推动摆杆摆动。2.2.3基础三功能实现的分析与计算示意图3：4图3轴流风机俯视图假设轴流风机呈“+”形状分布，分别对应X，Y轴方向，那么如果设定某一摆动方向，与X轴呈θ角，那么：xyFFtan，则)arctan(XyFF。这需要四台轴流风机配合，形成合力方可实现，而四台风机分别位于X，Y轴线上，只需要两个轴线上的风机各自产生的空气推力呈比例，即，xyFFtan。其中，θ是自行设置的，轴向风机应产生空气推力的比例为2，MCU将控制电机的PWM置为相应比例，反复调节几次便可以使摆动角度达到要求。2.2.4基础四的功能实现与计算拉起一定角度后，需要提供与运动方向相反的力，阻碍摆杆运动。设定值半长R=0，则)arctan(21LLR=0；此为平衡位置。重力方向（自然平衡点）为需要控制达到的转态，无论以何种方向拉起摆杆，倾角传感器的X、Y轴角度都会产生变化（除非沿轴向），这样，根据X、Y轴的倾角、角速度数据（PD算法）分别控制X、Y轴向的风机，使之分别达到平衡状态。2．3、发挥部分功能实现的分析与计算图4画圆示意图如上图，激光笔的圆周轨迹可以通过激光笔x轴的轨迹和y轴的轨迹合成得到。即当x轴和y轴两个方向的运动轨迹是等幅且相位相差90°，这样通过两个x和y两个方5向的运动合成，即可使激光笔的轨迹呈现一个圆。x轴和y轴方向的运动模型即是基础部分提到的直线运动模型。开始时让摆杆能在x轴方向稳定摆动一个角度θ，当摆到最高点时，同时让摆杆在y轴方向开始起振（即满足相位差为90°），并通过调节相对的两个风机转速是摆杆在y轴方向也稳定摆动θ（即满足振幅相等）三、电路与程序设计3.1、电路的设计3.1.1系统总体框图系统总体框图如图5所示，系统总体框图姿势采集模块单片机系统风力摆模块人机交互液晶显示模块图5系统总体框图3.1.2电路原理图见附录13.2基础部分系统框图与电路原理图3.2.1基础部分系统框图角度偏差Kp（比例）Kd(微分)PWM驱动风机风力摆系统设定值图6基础部分系统框图3.2.2、基础部分系统原理电路见附录163.3发挥部分系统框图与电路原理图3.3.1系统框图角度偏差Kp（比例）Kd(微分)PWM驱动风机风力摆系统设定值Ki（积分）摆杆姿态图7发挥部分系统框图3.3.2、发挥部分系统电路图见附录13.4电源用集成稳压器7805，电路图中，稳压器7805输入端的电容为输入端滤波电容，输出端的电容为输出端滤波电容；家用电22