简易旋转倒立摆及控制装置

1、简易旋转倒立摆及控制装置(参赛队员姓名： 指导教师姓名 参赛 队 编号：参赛学校：简易旋转倒立摆及控制装置（ C 题 ）摘 要：简易旋转倒立摆及控制装置是复杂的高阶闭环控制系统， 控制复杂度较 高。系统以飞思卡尔MK10DN512ZVLL单片机为核心，以Mini1024j编码器为角 度传感器，配合直流电机组成旋转倒立摆系统，经过充分的系统建模， 并考虑单 片机运算速度，最终确定采用改进的“模糊 PID ”控制算法，通过软件控制，可 以满足基本部分要求和发挥部分要求。系统的突出特点在于充分的力学理论分析，通过力学建模和控制系统仿真，获得了大量的定性分析结果，为系统的建立提供了很好的理论依据。关键

2、字：倒立摆 模糊PID力学建模 状态机一、系统方案1. 系统方案论证与选择倒立摆系统是一个复杂的快速、非线性、多变量、强耦合、自然不稳定的系 统。对于该控制系统而言，合适的控制算法、精确的反馈信号、适合的电机驱动 等都对系统的稳定性、控制精度及抗干扰性起重要作用。针对上述问题， 分别设 计多种不同的解决方案，并进行选择论证。（ 1）控制算法选择方案一：采用传统 PID 控制算法。传统PID控制算法是运用反馈求和后的误差信号的比例（0阶位置项）、积分（误差累积项 ）、微分（1 阶速度项 ）进行系统校正的一种控制算法。可用于被控对 象的结构和参数不能完全掌握， 或得不到的精确数学模型的情况， 控制

3、器的结构 和参数必须依靠经验和反复调试来确定。方案二：采用模糊PID控制算法模糊PID控制算法根据PID控制器的三个参数与偏差e和偏差的变化ec之 间的模糊关系，在运行时不断检测e及ec，通过事先确定的关系，利用模糊推理的方法，在线修改PID控制器的三个参数，让PID参数可自整定。将模糊控制 算法与传统PID控制算法巧妙结合，不但具有PID控制算法精度高等优点，又兼 有模糊控制灵活、适应性强的优点。综合考虑选择方案二的模糊 PID控制算法2）电动机选型方案一：选择步进电动机步进电动机是将电脉冲激励信号转换成相应的角位移或线位移的离散值控 制电动机， 这种电动机每当输入一个电脉冲就动一步。 虽然

4、控制时序和驱动电路 相对复杂，但步进距离很小，保持力矩大，制动能力强。但步进电机速度只在一 定范围可调，并且一般步进电机在不旋转时仍有若干相通电，功耗太大。方案二：选择直流电动机直流电动机控制简单，利用双极性PWM卩可实现调速和正、反转，功率调节范围广、适应性好。直流电机的起动、制动转矩大，易于快速起动、停车，易于 控制，且直流电机的调速性能好，调速范围广，易于平滑调节。综上考虑选择方案二的直流电动机。（3）传感器的选择方案一：使用角位移传感器角位移传感器是一个高精度的电位器， 它输出为模拟量。 但是在使用角位移 传感器时，为得到其与竖直方向 （即重力方向 ）的夹角，要使用重摆， 且在角度变

5、化小时，由于传感器自身扭矩，将不会发生角位移，从而得不到采样数据。方案二：使用主轴编码器主轴编码器采用与主轴同步的光电脉冲发生器， 通过中间轴上的齿轮 1:1 地 同步传动。一般是发光二极管发出红外光束，通过动、静两片光栅后，到达光电二极管，接收到脉冲信号，变换成数字量输出。按编码方式不同，分为增量式编 码器和绝对编码器。前者输出脉冲，后者输出8421 码。绝对值编码器减轻了电子接收设备的计算任务，从而省去了复杂的和昂贵的输入装置，而且， 当机器合 上电源或电源故障后再接通电源， 不需要回到位置参考点， 就可利用当前的位置 值，得到了广泛的应用。综上考虑选择方案二的绝对值式主轴编码器。2. 系

6、统结构基于题目要求及以上分析，本系统以飞思卡尔MK10DN512ZVLL单片机作为 核心处理芯片，包括摆杆状态检测、电机驱动、液晶显示等模块。系统框图如图 1 所示。图1 系统结构框图系统各部分功能如下。中央处理模块：该模块采用飞思卡尔 MK10DN512ZVLL1单片机作为主控制 器，完成系统的控制功能。摆杆检测模块： 该模块由主轴编码器构成， 用于检测摆杆的角位移及角速度， 并将信息反馈给 MCU。电机驱动模块：该模块由步进电动机实现，用于驱动旋转臂做往复运动。液晶显示模块：该模块由1.8寸SPI TFT全彩屏构成，用于实时动态显示摆杆角度，以及摆杆保持平衡状态后维持的时间、理论分析与计算

7、1. 系统模型的建立一级旋转式倒立摆系统由一个水平旋臂和一级摆杆组成， 旋臂由电机驱动在 水平面内作圆周运动，通过耦合作用带动摆杆转动。如图 2所示，旋臂和摆杆可 以抽象为两个匀质杆，其中旋臂长度为 R，相对y轴的角位移为 ；摆杆长度为 L,摆杆质心到连接点的距离为L' L2，相对z轴的角位移为。图2系统建模示意图由动力学理论，摆杆质心在x和z方向的速度分量为：Vx R& Leos && VyLsin & 系统总动能系统的动能由4部分构成，包括：旋臂在水平面上的转动， 摆杆在铅直平面 内的转动，摆杆质心沿X轴、z轴方向的运动。对应的动能分量分别用，T2，

8、T3， T4表示，因此系统动能T为这四个动能分量的和，系统动能如式(2):T Ji&72 J2&/2 m(R & L'eos ( &)丁2 m( L'sin (&)2/2 (2)其中，J2 mL''3。 系统总势能以旋臂所在水平面为零势能面，则系统的势能为摆杆的重力势能:V mgL'cos拉格朗日方程由拉格朗日算子H T V可推导出拉格朗日函数：H J182/2 J2&/2 mR2 &'/2 mL'Rcos (&( &) mgL 'cos 已知系统的广义坐标q

9、(i 1,2)可得方程组：，则由拉格朗日方程Ht "&其中，fi为系统广义坐标上非有势力对应的广义外力,M为电动机输出转矩，M m gKjKg(Um忑心).Rm,为旋臂绕电机转轴转动的阻尼系数，U 为电机电枢电压。将式(5)中的方程在(&&T(0 0 0 0) T处线性化，忽略高次项，最终可以得到系统的状态方程如式(6)所示001&000&04G3R&&4J1mR24J1mR203RG3(J1mR2)g(4J12mR )L'(4J12mR )L'00100+&4m gKjKg(4J12U mmR )Rm0

10、&3Rm gKjKg(4J1mR2)L'Rm其中，G ( m gKjKmK； Rm)JRm将系统的机械参数值带入式(6),可得倒立摆系统的线性化数学模型如式(5) 所示。&00100&00010+Um&&046.8111.870&55.15&&051.518.950&83.14y11 0 0&&T上述建模过程所需各机械参数如表 1所示表1系统物理参数表物理参数物理意义参数值摆杆长度0.199 m摆杆质量0.005 kg旋臂长度0.2 m旋臂质量0.01 kg电机力矩系数-3-13.87 X 10 N

11、- m- A反向电势系数4X 10-3 V- s - rad-1变速器齿轮比4.2:1直流电机电枢电阻0.476直流电机效率64.6 %变速器效率95 %4.16 X 10-3阻尼系数N- ms- rad-12. 控制器算法的设计自适应模糊PID控制器以误差e和误差变化ec作为输入，可以满足不同时 刻的e和ec对PID参数自整定的要求。利用模糊控制规则在线对PID参数进行修改，便构成了自适应模糊 PID控制器。但是这里有一个问题：通过上述建模， 若将&&乍为模糊控制器的4个输入，每个输入又选定7个词集的话，那么规则将有74=2401条，考虑到单片机的运算速度，这里考虑设计两个控

12、制器，分 别控制、&和 、&,由一个单片机并行运算处理。然后，将它们的输出决策 相加作为电动机的控制信号，来控制倒立摆的平衡。其结构如图3所示。图3模糊PID控制器结构隶属度函数对于旋臂的控制，取输入，&和输出Kp,Ti,Td模糊子集为 NB,NM,NS,Z,PS,PM,PB,分别代表负大，负中，负小，零，正小，正中，正大。 论域为-3,3，量化等级为-3,-2,-1,0,1,2,3。输入输出隶属度函数均采用三角形，如图4所示。图 4 输入输出量的隶属度函数对 于 摆 杆 的 控 制 ， 取 输 入 ,&和 输 出 Kp,Ti,Td 模 糊 子 集 为NB,NM

13、,NS,Z,PS,PM,PB,同上述对于摆杆的控制，输入输出隶属度函数也均采 用三角形， 但考虑倒立摆系统的控制以摆杆控制为主， 要求摆杆在角度为零时能 够平衡倒立故在零点附近分档较细，如图 5 所示。图 5 输入输出量的隶属度函数 模糊控制规则根据Kp",Td对输出特性的影响，可以归纳出在不同输入下， Kp",Td的自 整定要求，根据控制经验，可得模糊规则，如表 2 所示。对应模糊规则，可以完 成模糊推理，决策出模糊输出量。表2 Kp,Ti，Td模糊控制规则最后， 进行反模糊判决，利用重心法去模糊化，将模糊输出分解成实际作用 于电机的物理量。三、电路与程序设计1. 硬件电

14、路设计（1）主控电路设计主控电路设计如图6所示，系统采用飞思卡尔MK10DN512ZVLL作为主控芯 片，采集编码器的位置信息， 并根据倒立摆的角度和角加速度等数据计算摇臂运 动速度和方向，从而实现倒立摆的平衡。图 6 主控电路图（ 2）电机驱动电路系统中的电机采用MOS管组成H桥驱动电路，该驱动就有电路可靠，驱动能力强，成本低等优点，完全满足本系统的要求。电路如图 7 所示。图7 直流电机驱动图2. 系统软件设计（ 1） 软件设计为了支撑上述题目要求和控制算法， 并且降低模块间的耦合度从而为测试工 作提供方便，我们设计了如下的软件构架：设备驱动层设备驱动层是针对单片机外设的驱动控制信号和反馈

15、信号进行初步的封装， 从而实现高层逻辑不必关心时序或电压等数字、模拟信号层数据。I/O 数据配接层I/O 数据配接层实现输入输出数据与控制逻辑数据的匹配，包括数据类型转 换（ float ?unsigned int ）和数据缓冲维护。控制决策层控制决策层是控制系统的核心，其中包括系统状态控制和运动决策控制图8控制决策层框图由图8所示，控制决策层首先从数据配接层的输入缓冲读入控制外设和传感 器外设的反馈数据，首先根据数据进行状态控制，在确定系统状态之后再配合状 态数据进行运动决策，将决策结果发送至I/O输出数据配接模块从而实现对设备 的驱动。图8比较直观地说明了决策层在控制系统中所处的位置。 根

16、据上述分析, 软件设计流程如图9所示。图9软件流程图四、系统测试及结果分析针对竞赛最终测试项目及计划演示的扩展表演项目内容，制订并进行了如下测试，测试结果如表3所示。表3竞赛测试数据表测试项目测试次数成功（准确）次数成功（准确）率备注传感器部分静态角度测量2020100%误差0.1度动态角度测量2015 （误差小于75%已通过算0.5度次数）法优化基本部分自启动超60度2020100%自启动超360度2020100%165度自平衡201995%165自平衡旋转角度20125（平均最大138% （超过统计规律转角）90度）发挥部分自启动倒立2020100%5s内稳定施加扰动倒立2020100%倒

17、立转圈2020100%扩展液晶显示角度2020100%大扰动演示2017次85%20g砝码，90度干扰结果分析测试结果显示， 本设计已基本完成设计要求中所规定的各项， 并附加了相对 题目要求内容难度更大的受冲击后恢复平衡 （因为受冲击后， 倾角传感器内部会 产生震荡，影响定位精度，从而增加难度） ，并很好的完成。当然，系统在精确调整倒立摆角度等更高难度的任务上还存在很多问题， 在 今后的研究中， 我们将针对这些高级任务进行深入的分析， 并通过引入人工神经 网络等智能控制算法来解决这些问题。五、总结经过 4天 3夜的设计、构建，系统成功的完成了设计任务中的各项目标。在 整个系统设计过程中，不仅应用了大量的单片机技术、传感器技术、 自动控制理 论、数字 / 模拟电子电路技术和电机控制技术，还应用了数学、力学、机械学等 学科的知识。系统设计结构严谨、 理论准备充分、算法设计更是充满了创新意识。参考文献1 黄智伟 . 全国国大