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

简易旋转倒立摆及控制装置（C 题）参赛队员姓名：指导教师姓名参赛队编号：参赛学校：简易旋转倒立摆及控制装置（C 题）摘要：简易旋转倒立摆及控制装置是复杂的高阶闭环控制系统，控制复杂度较高。

系统以飞思卡尔MK10DN512ZVLL10单片机为核心，以Mini1024j编码器为角度传感器，配合直流电机组成旋转倒立摆系统，经过充分的系统建模，并考虑单片机运算速度，最终确定采用改进的“模糊PID”控制算法，通过软件控制，可以满足基本部分要求和发挥部分要求。

系统的突出特点在于充分的力学理论分析，通过力学建模和控制系统仿真，获得了大量的定性分析结果，为系统的建立提供了很好的理论依据。

关键字：倒立摆模糊PID 力学建模状态机一、系统方案1. 系统方案论证与选择倒立摆系统是一个复杂的快速、非线性、多变量、强耦合、自然不稳定的系统。

对于该控制系统而言，合适的控制算法、精确的反馈信号、适合的电机驱动等都对系统的稳定性、控制精度及抗干扰性起重要作用。

针对上述问题，分别设计多种不同的解决方案，并进行选择论证。

（1）控制算法选择方案一：采用传统PID控制算法。

传统PID控制算法是运用反馈求和后的误差信号的比例(0阶位置项)、积分(误差累积项)、微分(1阶速度项)进行系统校正的一种控制算法。

可用于被控对象的结构和参数不能完全掌握，或得不到的精确数学模型的情况，控制器的结构和参数必须依靠经验和反复调试来确定。

方案二：采用模糊PID控制算法模糊PID控制算法根据PID控制器的三个参数与偏差e和偏差的变化ec之间的模糊关系，在运行时不断检测e及ec，通过事先确定的关系，利用模糊推理的方法，在线修改PID控制器的三个参数，让PID参数可自整定。

将模糊控制算法与传统PID控制算法巧妙结合，不但具有PID控制算法精度高等优点，又兼有模糊控制灵活、适应性强的优点。

综合考虑选择方案二的模糊PID控制算法。

（2）电动机选型方案一：选择步进电动机步进电动机是将电脉冲激励信号转换成相应的角位移或线位移的离散值控制电动机，这种电动机每当输入一个电脉冲就动一步。

虽然控制时序和驱动电路相对复杂，但步进距离很小，保持力矩大，制动能力强。

但步进电机速度只在一定范围可调，并且一般步进电机在不旋转时仍有若干相通电，功耗太大。

方案二：选择直流电动机直流电动机控制简单，利用双极性PWM即可实现调速和正、反转，功率调节范围广、适应性好。

直流电机的起动、制动转矩大，易于快速起动、停车，易于控制，且直流电机的调速性能好，调速范围广，易于平滑调节。

综上考虑选择方案二的直流电动机。

（3）传感器的选择方案一：使用角位移传感器角位移传感器是一个高精度的电位器，它输出为模拟量。

但是在使用角位移传感器时，为得到其与竖直方向(即重力方向)的夹角，要使用重摆，且在角度变化小时，由于传感器自身扭矩，将不会发生角位移，从而得不到采样数据。

方案二：使用主轴编码器主轴编码器采用与主轴同步的光电脉冲发生器，通过中间轴上的齿轮1:1地同步传动。

一般是发光二极管发出红外光束，通过动、静两片光栅后，到达光电二极管，接收到脉冲信号，变换成数字量输出。

按编码方式不同，分为增量式编码器和绝对编码器。

前者输出脉冲，后者输出8421码。

绝对值编码器减轻了电子接收设备的计算任务，从而省去了复杂的和昂贵的输入装置，而且，当机器合上电源或电源故障后再接通电源，不需要回到位置参考点，就可利用当前的位置值，得到了广泛的应用。

综上考虑选择方案二的绝对值式主轴编码器。

2. 系统结构基于题目要求及以上分析，本系统以飞思卡尔MK10DN512ZVLL10单片机作为核心处理芯片，包括摆杆状态检测、电机驱动、液晶显示等模块。

系统框图如图1所示。

图1 系统结构框图系统各部分功能如下。

中央处理模块：该模块采用飞思卡尔MK10DN512ZVLL10单片机作为主控制器，完成系统的控制功能。

摆杆检测模块：该模块由主轴编码器构成，用于检测摆杆的角位移及角速度，并将信息反馈给MCU 。

电机驱动模块：该模块由步进电动机实现，用于驱动旋转臂做往复运动。

液晶显示模块：该模块由1.8寸SPI TFT 全彩屏构成，用于实时动态显示摆杆角度，以及摆杆保持平衡状态后维持的时间。

二、理论分析与计算1. 系统模型的建立一级旋转式倒立摆系统由一个水平旋臂和一级摆杆组成，旋臂由电机驱动在水平面内作圆周运动，通过耦合作用带动摆杆转动。

如图2所示，旋臂和摆杆可以抽象为两个匀质杆，其中旋臂长度为R ，相对y 轴的角位移为α；摆杆长度为L ，摆杆质心到连接点的距离为'2=L L ，相对z 轴的角位移为θ。

图2 系统建模示意图由动力学理论，摆杆质心在x 和z 方向的速度分量为：()()cos sin αθθθθ⎧=-⎪⎨=-⎪⎩ x yV R L V L (1)① 系统总动能系统的动能由4部分构成，包括：旋臂在水平面上的转动，摆杆在铅直平面内的转动，摆杆质心沿x 轴、z 轴方向的运动。

对应的动能分量分别用1T ，2T ，3T ，4T 表示，因此系统动能T 为这四个动能分量的和，系统动能如式(2)：22221222('cos ())('sin ())2αθαθθθθ=++-+- T J J m R L m L (2) 其中，22'3=J mL 。

② 系统总势能以旋臂所在水平面为零势能面，则系统的势能为摆杆的重力势能：'cos θ=V mgL (3)③拉格朗日方程由拉格朗日算子=-H T V 可推导出拉格朗日函数：222212222'cos ()()'cos αθαθθαθ=++-- H J J mR mL R mgL (4) 已知系统的广义坐标{},αθ=q ，则由拉格朗日方程⎛⎫∂∂∂-= ⎪∂∂∂⎝⎭ i i iHHf t q q ，(1,2)=i 可得方程组：ξαααθθ⎧∂∂∂⎛⎫-=- ⎪⎪∂∂∂⎪⎝⎭⎨∂∂∂⎛⎫⎪-= ⎪⎪∂∂∂⎝⎭⎩ H HM t H H t (5) 其中，i f 为系统广义坐标上非有势力对应的广义外力，M 为电动机输出转矩，()ηηα=-m g i g m g m m M K K U K K R ，ξ为旋臂绕电机转轴转动的阻尼系数，m U 为电机电枢电压。

将式(5)中的方程在T T ( )(0 0 0 0)ααθθ= 处线性化，忽略高次项，最终可以得到系统的状态方程如式(6)所示。

22211121222111000100000144300 + 44(4)33()300(4)'(4)'(4)'m g i g m m m g i gm K K G R U J mR J mR J mR R R K K J mR g RG J mR L J mR L J mR L R ααηηθθααθθηη⎡⎤⎡⎤⎢⎥⎢⎥⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥-⎢⎥⎢⎥=⎢⎥⎢⎥++⎢⎥⎢⎥+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥+-⎣⎦⎣⎦⎢⎥⎢⎥+++⎢⎥⎣⎦⎣⎦ (6) 其中，2()ηηξ=+m g i m g m m G K K K R R 。

将系统的机械参数值带入式(6)，可得倒立摆系统的线性化数学模型如式(5)所示。

[]T0010000010 + 046.8111.87055.15051.518.95083.14 1100m U y ααθθααθθαθαθ⎡⎤⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥=⎢⎥⎢⎥⎢⎥⎢⎥-⎢⎥⎢⎥⎢⎥⎢⎥-⎣⎦⎣⎦⎣⎦⎣⎦⎡⎤=⎣⎦(7) 上述建模过程所需各机械参数如表1所示。

表1 系统物理参数表物理参数物理意义 参数值 L摆杆长度 0.199 m m摆杆质量 0.005 kg R 旋臂长度 0.2 m M旋臂质量 0.01 kg i K 电机力矩系数 3.87×10-3 N ·m ·A -1m K 反向电势系数 4×10-3 V ·s ·rad -1g K变速器齿轮比 4.2:1 m R直流电机电枢电阻 0.476 Ω ηm直流电机效率 64.6 % ηg变速器效率 95 % ξ阻尼系数4.16×10-3 N ·ms ·rad -12. 控制器算法的设计自适应模糊PID 控制器以误差e 和误差变化ec 作为输入，可以满足不同时刻的e 和ec 对PID 参数自整定的要求。

利用模糊控制规则在线对PID 参数进行修改，便构成了自适应模糊PID 控制器。

但是这里有一个问题：通过上述建模，若将 αθαθ 作为模糊控制器的4个输入，每个输入又选定7个词集的话，那么规则将有74=2401条，考虑到单片机的运算速度，这里考虑设计两个控制器，分别控制α、α和θ、θ ，由一个单片机并行运算处理。

然后，将它们的输出决策相加作为电动机的控制信号，来控制倒立摆的平衡。

其结构如图3所示。

图3 模糊PID 控制器结构① 隶属度函数对于旋臂的控制，取输入,αα和输出,,p i d K T T 模糊子集为{NB,NM,NS,Z,PS,PM,PB}，分别代表负大，负中，负小，零，正小，正中，正大。

论域为[-3,3]，量化等级为{-3,-2,-1,0,1,2,3}。

输入输出隶属度函数均采用三角形，如图4所示。

-3-2-112300.51NBNMNSZPBPMPS图4 输入输出量的隶属度函数对于摆杆的控制，取输入,θθ 和输出,,p i dK T T 模糊子集为{NB,NM,NS,Z,PS,PM,PB}，同上述对于摆杆的控制，输入输出隶属度函数也均采用三角形，但考虑倒立摆系统的控制以摆杆控制为主，要求摆杆在角度为零时能够平衡倒立．故在零点附近分档较细，如图5所示。

-3-2-112300.51NBNMNSZPBPMPS图5 输入输出量的隶属度函数② 模糊控制规则根据,,p i d K T T 对输出特性的影响，可以归纳出在不同输入下，,,p i d K T T 的自整定要求，根据控制经验，可得模糊规则，如表2所示。

对应模糊规则，可以完成模糊推理，决策出模糊输出量。

K T T模糊控制规则表2 ,,p i d最后，进行反模糊判决，利用重心法去模糊化，将模糊输出分解成实际作用于电机的物理量。

三、电路与程序设计1. 硬件电路设计（1）主控电路设计主控电路设计如图6所示，系统采用飞思卡尔MK10DN512ZVLL10作为主控芯片，采集编码器的位置信息，并根据倒立摆的角度和角加速度等数据计算摇臂运动速度和方向，从而实现倒立摆的平衡。

图6 主控电路图（2）电机驱动电路系统中的电机采用MOS管组成H桥驱动电路，该驱动就有电路可靠，驱动能力强，成本低等优点，完全满足本系统的要求。