一级倒立摆的建模及控制分析

直线一级倒立摆的建模及控制分析摘要：本文利用牛顿一欧拉方法，建立了直线型一级倒立摆系统的数学模型。 在分析的基础上，采用状态反馈控制中极点配置法设计了用于直线型一级倒立摆系统的控制器。此外，用MATLAB仿真绘制了相应的曲线并做了分析。一、 问题描述倒立摆控制系统是机器人技术、控制理论、计算机控制等多个领域和多种技术的有机结合，其被控系统本身是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统，是控制理论研究中较为理想的实验对象。它为控制理论的教学、实验和科研构建了一个良好的实验平台，促进了控制系统新理论、新思想的发展。倒立摆系统可以采用多种理论和方法来实现其稳定控制，如 PID，自适应、状态反馈、智能控制等方法都己经在倒立摆控制系统上得到实现。由于直线一级倒立摆的力学模型较简单，又是研究其他倒立摆的基础，所以本文利用所学的矩阵论知识对此倒立摆进行建模和控制分析。二、 方法简述本文利用牛顿一欧拉方法，建立了直线型一级倒立摆系统的数学模型。在分析的基础上，采用状态反馈控制中极点配置法设计了用于直线型一级倒立摆系统的控制器。此外，用MATLAB仿真绘制了相应的曲线并做了分析。三、 模型的建立及分析3.1微分方程的推导在忽略了空气阻力，各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，如下图1所示

直线一级倒立摆系统图1直线一级倒立摆系统图1假设M为小车质量；m为摆杆质量；b为小车摩擦系数；I为摆杆转动轴心到杆质心的长度；I为摆杆惯量；F为加在小车上的力；x为小车位置；'为摆杆与垂直向上方向的夹角；二为摆杆与垂直向下方向的夹角。图2是系统中小车和摆杆的受力分析图。其中，N和P为小车与摆杆相互作用力的水平和垂直方向的分量。值得注意的是：在实际倒立摆系统中检测和执行装置的正负方向已确定，因而矢量方向定义如图2所示，图示方向为矢量正向。(a)(b)(a)(b)图2小车和摆杆的受力分析图分析小车水平方向所受的合力，可以得到以下方程:(1)Mx=F-bx-N(1)由摆杆水平方向的受力进行分析可以得到下面等式:N二mxml)cos-ml)2sin把这个等式代入上式中，就得到系统的第一个运动方程:MmxbxmPcos^-mP2sin=F

为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析,可以得到下面方程：■■'2TOC\o"1-5"\h\zP-mg二-mlrsin-mlcos 梓）力矩平衡方程如下：\o"CurrentDocument"-Plsin八Nlcos：-H （5）合并这⑷、（5）两个方程，约去P和N，得到第二个运动方程：Iml2二mglsin二-mlxcos （6）假设■■与1（单位是弧度）相比很小，即卩••《1,则可以进行近似处理:,〔d日Yco<s=-1，sin=-0， —I=0⑴丿用u来代表被控对象的输入力F，线性化后两个运动方程如下:■-2(I+ml-mgl©=mlx(8)<..(8)Mmxbx-ml〜u3.2状态空间方程方程组（8）对x，「解代数方程，整理后的系统状态空间方程为:■0001-Iml■0001-Iml2b2IMmMml0-mlbIMmMml202|2mgl2IM-mMml0mglMmIMmMml20ml2. 2IMmMml0ml」(M+m)+Mml2000010xl0000100u_0对于质量均匀分布的摆杆有：I=ml2/3，于是可得:ml2/3ml2 -mgl二mlx化简得：厂=3g...3%4l4l设X,x，''，\u^=x，则有：

■xl01001xlx0000■xl01001xlx0000x=0001*3gj000一L<■0113.3实际系统模型03-41 」+Ui*y=0ui一0L*实际系统模型参数：M=1.096Kg；m=0.109Kg；b=0.1N/m/s；1=0.25m；1=0.0034kg•m•m；采样频率T=0.005So以小车加速度作为输入的系统状态方程：10001一0■xl10001一0■xl000I010*0U1一03.4状态空间极点的配置对于直线一级倒立摆的极点配置转化来说：要按上述系统设计控制器，则要求具有较短，约3s的调整时间和合适的阻尼比Z=0.5。要使系统具备能控、能观且易验证。步骤为：计算特征值。根据要求，设调整时间为3s,并留有一定的余量,选择期望的闭环极点：s=7i=1,2,3,4，其中:^=-10,J2=-10,,-223j,4=-2-2,3j,其中%,4是一对具有Z=0.5,w^4的主导闭环极点。叫,2位于主导闭环极点的左边，其影响较小，因此期望的特征根方程为:s为:s424s319& 72016000由此得到：c=24,a2-196,a3-720,a4=16000ssi—A=000ssi—A=00000s—29.4=s—29.4s,因此：b=b3=b4=0,b^——29.4o_1系统的反馈增益矩阵为：K-a^-a^i-'da2-'da^^b1T确定使状态方程变为可空标准型的变换矩阵T=MW，于是可得:

-■0100ABA2BA3bL100003088.23088.20M=Bbi11-0-29.401110—-29.401010011000_-1000_b3b2W」bi110则反馈增益矩阵为:则有:则反馈增益矩阵为:■-29.40101■-0.03400.011010-29.401 10-0.03400.011，T=0030000.3330.0003110000.333一T=MWK-1-54.4218-24.489893.273916.1633】控制量为 --KX=54.4218x24.4898x-93.2739-16.16333.5MATLAB仿真分析利用MATLAB软件对直线一级倒立摆进行了仿真，仿真绘制的曲线图，如图3,4所示。图3小车位置随时间变化图4阀时图图3小车位置随时间变化图4阀时图4摆角随时间变化图采用极点配置法设计的用于直线型一级倒立摆系统的控制器 ，可使系统在很小的振动范围内保持平衡，小车振动幅值约为510-3