《倒立摆系统的状态空间极点配置控制设计.docx》由会员分享，可在线阅读，更多相关《倒立摆系统的状态空间极点配置控制设计.docx（15页珍藏版）》请在三一办公上搜索。
1、倒立摆系统的状态空间极点配置控制设计倒立摆系统的状态空间极点配置控制设计 电子与信息工程学院 自动化094 丛长龙 摘要：为实现多输入、多输出、高度非线不稳定的倒立摆系统平衡稳定控制，将倒立摆系统的非线性模型进行近似线性化处理，获得系统在平衡点附近的线性化模型。利用牛顿欧拉方法建立直线型一级倒立摆系统的数学模型。在分析的基础上，基于状态反馈控制中极点配置法对直线型倒立摆系统设计控制器。由MATLAB仿真表明采用的控制策略是有效的，设计的控制器对直线型一级倒立摆系统的平衡稳定性效果好，提高了系统的干扰能力。 关键词：倒立摆、极点配置、MATLAB仿真 引言：倒立摆是进行控制理论研究的典型试验平台
2、，由于倒立摆本身所具有的高阶次、不稳定、非线性和强耦合性，许多现代控制理论的研究人员一直将他视为典型的研究对象，不断从中发掘出新的控制策略和控制方法。控制器的设计是倒立摆系统的核心内容，因为倒立摆是一个绝对不稳定的系统，为使其保持稳定并且可以承受一定的干扰，基于极点配置法给直线型一级倒立摆系统设计控制器 1数学模型的建立 倒立摆系统其本身是自不稳定的系统，实验建模存在着一定的困难。在忽略掉一些次要的因素之后，倒立摆系统就是一典型的运动的刚体系统，可以在惯性坐标系中应用经典力学理论建立系统动力学方程。下面采用牛顿-欧拉方法建立直线型一级倒立摆系统的数学模型。 1.1微分方程的数学模型 在忽略了空
3、气阻力和各种摩擦力之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，如图1所示： 1 倒立摆系统的状态空间极点配置控制设计 电子与信息工程学院 自动化094 丛长龙 图1：直线一级倒立摆模型 设系统的相关参数定义如下： M：小车质量 m：摆杆质量 b：小车摩擦系数 l：摆杆转动轴心到杆质心的长度 I：摆杆质量 F：加在小车上的力 x：小车位置 ：摆杆与垂直方向上方向的夹角 ：摆杆与垂直方向下方向的夹角 如下图2所示为小车和摆杆的受力分析图。其中，N和P为小车与摆杆相互作用力的水平和垂直方向的分量。 2 倒立摆系统的状态空间极点配置控制设计 电子与信息工程学院 自动化094 丛长龙 图2
4、：小车和摆杆受力分析图 应用牛顿方法来建立系统的动力学方程过程如下： 分析小车水平方向所受的合力，可以得到以下的方程： Mx=F-bx-N 由摆杆水平方向的受力进行分析可以得到下面的等式： d2N=m2(x+lsinq) dt将此等式代入上述等式中，可以得到系统的第一个运动方程： (M+m)x+bx+mlqcosq-mlqsinq=F 为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面的方程： d2P-mg=-m2(lcosq) dt2力矩平衡方程如下： -Plsinq-Nlcosq=Iq 注意：此方程中力矩的方向，由于 q=p+fcosf=-cosq sinf=-
5、sinq故等式前面有负号。 合并这两个方程，约去P和N，得到第二个运动方程： (I+ml)q+mglsinq=-mlxcosq 2设=+，当摆杆与垂直向上方向之间的夹角与1相比很小时，即1时，则可以进行如下近似处理： 3 倒立摆系统的状态空间极点配置控制设计 电子与信息工程学院 自动化094 丛长龙 cosq=-1sinq=-f dq2=0dt线性化后得到该系统数学模型的微分方程表达式： 2(I+ml)f-mglf=mlx (M+m)x+bx-mlf=u1.2状态空间数学模型 控制系统的状态空间方程可写成如下形式： X=AX+Bu Y=CX+Du解代数方程可得如下解： x=x-(I+ml2)b
6、m2gl2(I+ml2)x+f+ux=222I(M+m)+MmlI(M+m)+MmlI(M+m)+Mml f=f-mlbmgl(M+m)mlf=x+f+u222I(M+m)+MmlI(M+m)+MmlI(M+m)+Mml整理后可得系统的状态空间方程： 4 倒立摆系统的状态空间极点配置控制设计 电子与信息工程学院 自动化094 丛长龙 0x0x=0f0f1-(I+ml2)bI(M+m)+Mml20-mlbI(M+m)+Mml20m2gl2I(M+m)+Mml20mgl(M+m)I(M+m)+Mml200x2I+ml02xI(M+m)+Mml+u1f0mlf02I(M+m)+Mmlxx1000x0
7、y=+u f0010f0f对于质量均匀分布的摆杆，其转动惯量为： 1I=ml2 3代入微分方程模型中得： 122(ml+ml)f-mglf=mlx 3化简后可得： 3g3f=f+x 4l4l设X=xxff,u=x则有： T 5 倒立摆系统的状态空间极点配置控制设计 电子与信息工程学院 自动化094 丛长龙 0x0x=0f0f1000003g04l0x010x1+0uf30f4lxx1000x0y=+uf0010f0f1.3实际系统模型 实际系统参数如下： M：小车质量，0.5Kg; m：摆杆质量，0.2Kg; b：小车摩擦系数，0.1N/m/sec； l：摆杆转动轴心到杆质心的长度，0.3m;
8、 I：摆杆质量，0.006Kgmm； T：采样时间，0.005s。 将上述系统参数代入可得系统实际模型。 摆杆角度和小车位移的传递函数： 0.06s2 =2X(s)0.024s-0.588f(s)摆杆角度和小车加速度之间的传递函数： f(s)V(s)=0.060.024s2-0.588摆杆角度和小车所受外界作用力的传递函数： 6 倒立摆系统的状态空间极点配置控制设计 电子与信息工程学院 自动化094 丛长龙 4.545s2 =432U(s)s+0.182s-31.18s-4.45sf(s)以外界作用力作为输入的系统状态方程： &0100x0x&0-0.1822.67270x&1.8182x=+
9、u&f0001f0&f0-0.454531.1820f4.5454 x&0x1000x+u y=f0010f0&f以小车加速度作为输入的系统状态方程： &0x&0x=&0f&f0100000024.50x0x&10+u1f0&0f2.5 x&0x1000x+uy=f0010f0&f 2.状态空间极点配置 经典控制理论的研究对象主要是单输入单输出的系统，控制器设计时一般需要有关被控对象的较精确模型，现代控制理论主要是依据现代数学工7 倒立摆系统的状态空间极点配置控制设计 电子与信息工程学院 自动化094 丛长龙 具，将经典控制理论的概念扩展到多输入多输出系统。极点配置法通过设计状态反馈控制器将多
10、变量系统的闭环系统极点配置在期望的位置上，从而使系统满足瞬态和稳态性能指标。 设计要求： 用极点配置方法设计控制器，使得在小车上施加0.1N的阶跃信号时，闭环系统的响应指标为： 要求系统调整时间小于3s 稳态时摆杆与垂直方向的夹角变化小于0.1弧度 状态方程为： X=AX+Bu 选择控制信号： u=-KX 可解得： x(t)=(A-BK)x(t) 直接利用MATLAB极点配置函数K，PREC，MESSAGE=PLACE(A，B，P)来计算。选取调整时间ts=2.0s，阻尼比为=0.5，可得期望的闭环极点： u1=-10u2=-10u3=-2+j23u3=-2-j23 u3，u4为一对主导极点，
11、u1，u2距离闭环主导极点5倍，可忽略其对主导极点的影响。 矩阵的特征值是方程式| Is-|=0的根： s0000000s000-0s0000s010000001+k1k2k3k4=00001b0a0这是 s 的四次代数方程式，可表示为 8 倒立摆系统的状态空间极点配置控制设计 电子与信息工程学院 自动化094 丛长龙 s4+(k2+bk4)s3+(-a+k1+bk3)s2+ak2s-ak1=0 适当选择反馈系数 k1 , k2，k3，k4 系统的特征根可以取得所希望的值。 把四个特征根l1,l2,l3,l4设为四次代数方程式的根，则有 2s4-(l1+l2+l3+l4)s3+(ll+ll+l
12、l+ll+ll+ll)s-(ll12233441132412l3+l2l3l4+ll13l4+l4ll12)s+ll12l3l4=0 如果给出的l1,l2,l3,l4 是实数或共轭复数，则联立方程式的右边全部为 实数。据此可求解出实数k1,k2,k3,k4 当将特征根指定为下列两组共轭复数时 l1,l2,l3,l4 = -223j，-10, -10 又a = 29.4, b = 3 利用方程式可列出关于k1,k2,k3,k4的方程组： k2+3k4=24-29.4+k1+3k3=196-29.4k2=720-29.4k1=1600求解后得 k1=-65.3061 k2=-29.3878 k3=
13、114.3224 k4=21.3551 所以反馈矩阵： K=-65.3061-29.3878114.322421.3551 即施加在小车水平方向的控制力 u： = KX = -65.3061x + -29.3878x - 114.3224 -21.3551 3.仿真验证 9 倒立摆系统的状态空间极点配置控制设计 电子与信息工程学院 自动化094 丛长龙 图3：倒立摆极点配置仿真框图 可以看出在干扰的情况下，系统在3s之内基本上可以恢复到新的平衡位置。 图4：直线一级倒立摆状态空间极点配置MATALAB SIMULINK仿真结果图 10 倒立摆系统的状态空间极点配置控制设计 电子与信息工程学院
14、自动化094 丛长龙 图5：直线一级倒立摆状态空间极点配置实时控制结果 在给倒立摆施加干扰后，系统的响应如图12所示，系统的稳定时间在3s之内，达到设计要求。 4结论 传统的非线性系统分析方法需要非线性系统的精确模型，而实际中存在的大量复杂的多变量非线性系统则表现为参数的不确定性和结构的不确定性。本文用现代控制理论的极点配置方法对直线一级倒立摆控制进行了分析，并用Simulink进行了倒立摆的系统仿真。 通过实验，得到如下结论： (1) 对于具有非线性、多变量等特点的倒立摆系统进行系统分析，分析其非线性因素，在误差允许的范围内忽略某些次要因素将其线性化。 (2)状态空间极点配置控制器既能实现对
15、摆杆角度的控制，又能控制小车位移。 基于极点配置法对直线型一级倒立摆系统设计的控制器，可使系统在很小振动范围内保持平衡，稳态时摆杆与垂直方向的夹角变化小于0.1弧度，系统稳定时间约为3 S。 11 倒立摆系统的状态空间极点配置控制设计 电子与信息工程学院 自动化094 丛长龙 5.参考文献 1于长官，现代控制理论第3版哈尔滨工业大学出版社，2005 2郭钊侠，方建安，苗清影倒立摆系统及其智能控制研究J东华大学学报，2003，29(2)：122126 3刘豹现代控制理论M北京：机械工业出版社，2005 4王正林，王胜开MATLABSimulink与控制系统仿真M北京：电子工业出版社，2005 5段学超，仇原鹰，段宝岩，等平面倒立摆自适应滑模模糊控制J控制与决策，200722(7)：774777 6郑科，徐建明，俞立基于TS模型的倒立摆最优保性能模糊控制J控制理论与应用，2004，21(5)，703708 12
