基于LMI的二级倒立摆的建模与仿真

基于LMI的二级倒立摆系统的

∞

H鲁棒控制

摘要倒立摆系统为典型的快速、多变量、非线性、绝对不稳定系统, 且存在不确定因素。针对二级倒立摆系统中所受摩擦的不确定性，采用LMI方法, 建立

了二级倒立摆模型，设计了

∞

H鲁棒控制器, 给出了控制器的求解方法。仿真实验结果证明了该控制方法的有效性和可行性，并且具有很好的鲁棒稳定性和响应速度快的优越性，对高阶次不稳定系统具有很好的控制效果。

关键词：二级倒立摆；线性矩阵不等式（LMI）;

∞

H鲁棒控制

0 引言

现代控制工程所面临的问题极其复杂。实际的工程控制系统中, 总是存在一定的不确定性。倒立摆即是一个包含不确定性的系统, 也是控制理论的一个理想实验平台, 对倒立摆系统的研究具有重要的理论和实际意义。

本文采用线性矩阵不等式(LMI)方法，设计了二级倒立摆系统的鲁棒

∞

H状态

反馈控制器，有效地克服了用求解两个联立的里卡迪方程获得

∞

H控制器时求解过程不容易收敛的困难，并且可降低控制器参数的数量级，使其在实控上易于实现。根据文献[1]中对LMI的处理方法, 对二级倒立摆系统进行了仿真研究，结果表明，这样的控制方法可使二级倒立摆系统具有很好的鲁棒稳定性。

1 二级倒立摆系统建模

1.1 倒立摆系统结构

图1是二级倒立摆的系统结构图，它由三部分组成：计算机、电气部分和机

械部分。计算机部分有A/D、D/A转换模块，运动控制卡和PC机；电气部分主要

有：光电编码器、直流功率放大器、伺服电机和保护电路；机械部分有摆杆、轨

道、运动小车和皮带轮等。

计算机伺服驱动器

运动控制卡

伺服

电机

小车

下摆杆

上摆杆光电编码器1

光电编码器2

光电编码器3

图1 二级倒立摆系统结构图

1.2 倒立摆系统特性分析

倒立摆系统是典型的机械电子系统，具有如下特性：

（1）欠冗余性。一般的倒立摆控制系统采用单电机驱动，无冗余结构。采用欠冗余的设计方法主要是在不失系统可靠性的前提下节约经济成本或节约有效的空间。

（2）仿射非线性系统。倒立摆控制系统是一种典型的仿射非线性系统，可以用微分几何的方法进行分析。

（3）不确定性。主要是指建立系统的数学模型时的参数误差、量测噪声以及机械传动过程中的非线性因素所导致的难以量化的部分。

（4）耦合特性。倒立摆和小车之间，以及多级倒立摆的上下杆之间都是强耦合的。

（5）开环不稳定性。倒立摆系统有两个平衡状态：竖直向下和竖直向上。竖直向下的状态是系统稳定的平衡点（考虑摩擦力的影响），而竖直向上的状态是系统不稳定的平衡点，开环时微小的扰动都会使系统离开竖直向上的状态而进入竖直向下的状态。

针对倒立摆系统的以上特性，在建模时，为了简单起见，一般忽略系统中些次要的、难以建模的一些因素，例如空气阻力、伺服电机由于安装而产生的静摩擦力、系统连接处的松弛程度、摆杆连接处质量分布的不均匀、传动皮带的弹性、传动齿轮的间隙等，将小车抽象为质点，摆杆抽象为匀质刚体，摆杆绕轴转动，这样可以通过力学原理建立系统较为精确的数学模型。

为了研究倒立摆系统的控制方法，建立一个比较精确的倒立摆系统的线性模型是必不可少的。目前，对倒立摆系统建模一般采用两种方法：牛顿力学分析方法和Lagrange方程法。

1.3 倒立摆系统数学建模

为了简化二级倒立摆系统的数学模型，忽略空气流动作用在摆杆上的力矩干扰和上下摆转轴处的摩擦力矩，仅考虑小车与导轨的摩擦之后，可将倒立摆系统抽象成小车匀质杆和质量块组成，模型如图2所示。图中字母的意义和相关参数值如表1所示。

小车

x

y

导轨F

摆杆1

摆杆2质量块x

图2 二级倒立摆结构图 表1 二级倒立摆参数

参数符号

含义 参数值 M

小车质量 1.32kg 1m 上摆杆质量 0.04kg 2m

下摆杆质量 0.132kg 3m

质量块质量

0.208kg

1θ

下摆摆杆与垂直向上方向的

夹角

2θ

上摆摆杆与垂直向上方向的

夹角

1l 下摆摆杆转动中心到摆杆质

心的距离

0.09m

2l

上摆摆杆转动中心到摆杆质

心的距离 0.27m

F 电机对小车的驱动力

x

小车位移

1.3.1 利用拉格朗日（Lagrange ）方程推导动力学方程

拉格朗日（Lagrange ）方程为：

i i

i

f q L

q L dt =∂∂-∂∂∙

d （1） L 为拉格朗日算子，q 为系统的广义坐标，i=1,2,3...,n ，i f 为系统沿广义

坐标方向上的外力。

),(),(),(∙

∙

∙

-=q q V q q T q q L （2） 其中，T 为系统的动能，V 为系统的势能利用Lagrange 方程，可以推导二级倒立摆的动力学方程，设系统的三个广义坐标分别是x,1θ,2θ.

第一步计算系统的动能：

321m m m M T T T T T +++= （3） 其中M T ,1m T ，2m T ，3m T 分别表示小车，摆杆1，摆杆2，质量块的动能。而

'''111m m m T T T +=，其中'1m T 是摆杆1质心平动动能，'

'1m T 是摆杆1绕质心转动动能。'''2

22m m m T T T +=，其中'2m T 是摆杆2质心平动动能，''2m T 是摆杆2绕质心转动动能。 小车动能：

2

2

1∙=x M T M （4）

摆杆1动能：

()()21

21111112121

112111'm 21cos 2

1cos sin 211∙∙∙∙+-=⎪⎭⎪⎬⎫⎪⎩⎪⎨⎧⎥⎦⎤⎢⎣⎡-+⎥⎦⎤⎢⎣⎡-=θθθθθl m x l m x m dt l l d dt l x d m T

（5）

又因为 212

112111211'

'613121211

∙=⎪⎭

⎫ ⎝⎛==θl m w l m w J T m （6）

2

1211111121'''

3

2cos 211

1

1∙∙∙∙+-=+=θθθl m x l m x m T T T m m m （7）

摆杆2动能：

()()2

22211122

22211122

2211212222112'm sin sin 221cos cos 221cos cos 2221sin sin 2212

⎪

⎪⎪⎭

⎫

⎝⎛++⎪⎭⎫ ⎝⎛--=⎪⎭

⎪⎬⎫⎪⎩⎪⎨⎧⎥⎦⎤⎢⎣⎡--++⎥⎦⎤⎢⎣⎡--=∙∙∙∙∙θθθθθθθθθθθθl l m l l x m dt l l l l d m dt l l x d m T

（8）