倒立摆仿真数学建模
第27卷第3期2009年5月
吉林大学学报(信息科学版)
JournalofJilinUniversity(InformationScienceEdition)
V01.27No.3
May2009
文章编号:1671-5896(2009)03-02424)6
倒立摆控制的设计与仿真
王春民,栾
卉,杨红应
(吉林大学仪器科学与电气-r"程学院,长春130061)
摘要:针对倒立摆的稳定控制问题,阐述了二阶倒立摆的数学模型,采用线性二次最优控制理论,设计了倒立摆控制系统的线性二次型调节器和线性二次型输出器,使倒立摆系统闭环稳定。在Maflab6.5环境下,对倒立摆系统在两种控制器作用下的控制过程进行仿真。结果表明,在非线性控制问题中,线性二次型输出器与线性二次型调节器相比,对倒立摆系统的控制更有优势。
关键词:倒立摆;线性最优控制;线性二次型调节器;线性二次型输出器
中图分类号:粥91.9
文献标识码:A
DesignandSimulationofInvertedPendulumControl
WANGChun—min,LUANHui,YANGHong—ying
(College
of
InstrumentationandElectrical
Engineering,JilinUniversity,Changchun130061,China)
Abstract:Thesecondordermathematicalmodelsofinvertedpendulumsystem
on
are
expatiatedinthispaperbased
and
thetheoryof
LQOC
Linear
QuadraticOptima/Contr01),LQY(Linear—QuadraticYield)controller
LQR
(Linear-QuadraticRegulator)are
process
designedtomaketheinveaedpendulumsystemclosedloopstable.ThecontrolsimulatedundertwocontrolleraccordingtotheMatlab6.5environment,the
over
ofinvertedpendulums
ale
resultindicatesthatlinear—quadraticyieldcontrollerhaspotentialadvantagesKeywords:inverted
the
LQR.
pendulums;linealquadraticoptimal
control(LQOC);lineal—quadraticregulator
(LQR);lineal—quadraticyield(LQY)
引言
由于倒立摆系统的高阶次、不稳定、多变量、非线性和强耦合等特性,许多现代控制理论的研究人
员一直将其视为研究对象n“],用来描述线性控制领域中不稳定系统的稳定化和非线性控制领域中的变结构控制、无源性控制、自由行走、非线性观测器、摩擦补偿和非线性模型降阶等,并不断从中发掘新的控制理论和控制方法[5’6]。相关的理论成果已在直升飞机、火箭发射、人造卫星运行,机器人举重物、做体操和步行走等方面获得了广泛应用。对倒立摆系统的研究具有深远的理论意义和重要的工程背景。笔者在总结前人研究成果的基础上,综合分析了线性二次最优控制理论在倒立摆控制中的应
用一圳.并在Madat,6.5环境下对倒立摆控制系统进行了仿真。1
1.1
倒立摆的数学模型
工作原理
倒立摆的工作原理可简述为:用一种强有力的控制方法使小车以一定的规律来回跑动,从而使全部
收稿日期:2009-02-27
基金项目:国家重点基础研究发展规划(973)基金资助项目(2002CB412600)
作者简介:王春民(1948一),男,内蒙古乌兰浩特人,吉林大学教授,硕士生导师,主要从事现代控制理论、DSP与运动控制、
系统辨识与建模研究,(T锐)86.13578899158(E-mail)were@jimedu.en.
第3期
王春民,等:倒立摆控制的设计与仿真
243
摆杆在垂直平面内稳定,这就是倒立摆控制系统。若小车不动,摆杆会由于重力倒下;若在水平方向给小车一个力,则摆杆朝与小车运动方向相反的方向运行,通过有规律性地改变小车的受力方向,使摆杆在竖直方向左右摆动,从而实现摆杆在竖直方向的动态平衡。
为了简化系统分析,假设:1)二级摆体视为刚体;2)各部分的摩
擦力(力矩)与相对速度(角速度)成正比;3)施加在小车上的驱动图l二阶倒立摆系统模型图力与加在功率放大器上的输入电压成正比,并无延时地施加到小车上;Fi昏lne∞condordermodel。4)皮带轮与传送带之间无滑动,转送带无伸长现象。所以,可将倒立ofinvertedpendulum摆系统抽象成小车和匀质刚性杆组成的系统,二阶倒立摆的系统模型如图1所示。
上摆杆
1.2二阶倒立摆模型
系统模型参数如下:下摆与小车驱动系统的等效质量M=1.328kg;小车质量m,=0.208kg;下摆杆质量ml=0.220kg;上摆杆质量m2=0.187kg;下摆杆质心到轴心距离Z。=O.304m;上摆杆质心到轴心距离l:=0.226m;加在小车上的力为F;下摆杆与垂直方向夹角为0,;上摆杆与垂直方向夹角为
巩。
为了简化系统模型,建立系统的拉格朗日方程
工(q,每)=T(口,香)一y(g,香)
其中£为拉格朗日算子,g为系统的广义坐标,r为系统动能,y为系统势能。拉格朗日方程由q和L
表示为
苦(嚣)一薏=z
其中Z为系统沿该广义坐标方向的外力。
由于在广义坐标系下,0。,612没有外力作用,所以
蔷(等)一嚣=00
未(黠)一箍=0
df\a毋1J
一
a
(1)
、‘,
】
(2)
解此方程组并在平衡点石=0,=02=0和互=岛=晚=0附近对方程进行线性化处理,即设
sin日≈0,COS
p—l,线性化后得
i》l=kn01+忌13晚+J|}17戈如=后筮扫l+五为兜+k27.鬈
状态方程
(3)(4)
由于采用加速度作为输入,因此还要加上一个方程:髫=犯,其中U为控制能量作适当变换,得系统
,王=A…x+一B—u
其中状态变量工=[茗l,石2,石3,算4,%,‰]7=[r,01,如,,=,扫1,02]’,Y=[茗l,石2,名3]T=[r,01,如]7,
000
A=
000
0k12
0k13
000
O00
000
0O0
0O0
l0O
O1O
OOl
,B=
1k17k27000
r1
010
001
000
000
030
,C=l
0
l,D=03。l
L00a
kk
2
线性二次型最优控制问题
线性二次型(LQ:LinearQua&atic)是指系统的状态方程是线性的,指标函数是状态变量和控制
吉林大学学报(信息科学版)第27卷
变量的二次型。线性二次型控制理论已成为反馈系统设计的一种重要工具。其特点是:1)为多变量反
馈系统提供一种有效的分析方法;2)可适应多变量系统;3)可处理扰动信号和扰动噪声问题;4)可
处理有限和无限空间问题。研究二次型问题一方面是因为这类问题在工程实际中经常被应用;另一方面
是因为在数学上处理比较简单,可得到解析表达式的线性反馈控制律,便于工程实现。
2.1
LQR线性二次型调节器设计
LQR(LinearQuadraticRegulator)调节器设计的目的就是寻找状态反馈调节规律n(t)=一Kct(t),
使用性能指标函数
^=÷x7Ⅳ,+÷[[x7Q,+H7足,Ⅱ]dt
为最小,可求得最优反馈控制律
(5)
(6)K,=(B’SB+足,)一(丑7鼢)
从而实现对系统的闭环稳定控制。其中S=A7SA—A7SB(B7SB+足,)。1矿鼢+Q,,Q,由Riccat方程获得,足,为权矩阵,分别对状态向量z(t),控制量职(t)引起的性能度量的敏感程度进行加权,终端约束项N,=O。
2.2
LQY线性二次型输出器设计
设输出反馈控制(LQY:LinearQuadraticYield)节律的形式为口(f)=K,x(t),此时可通过使用性能指标函数
L=如’NrY+寺【[y7Q,+口’R,u3dt
为最小,求出状态反馈增益矩阵
(7)
墨=(曰‘S曰+足,)“(曰1鼢)
(8)
其中S=A’SA—A’SB(B’SB+R,)。1曰’鼢+Q,,Q,,置,为权矩阵,分别对输出向量Y(t)和控制向
量Ⅳ(t)引起的性能度量的敏感程度进行加权,终端约束项N,=0。可见,输出调节器的最优控制规律不是输出量Y(t)的线性反馈,而是状态X(t)的线性反馈。
3
倒立摆控制过程仿真
在Matlab6.5环境下,对倒立摆控制系统进行仿真分析。根据相关参数计算的各系数矩阵如下
O0
O00024.8355161.315l
O00O一6.8974149.6025
lO000O
01O000
030l
,B=
O00
00O
l1.82661.1940
r
3.1二阶倒立摆仿真
0OO
,
A
O
2
r1
010
001
000
000
030
c=l
0L0
I,D=03。l
0J
3.1.1
LQR线性二次调节器
最优控制的前提条件是系统是能控的,下面判断系统的能控能观性。系统能控矩阵的秩rank(ctrb(A,曰))=6,系统能观矩阵的秩rank(obsv(A,B))=6,可以判断系统是能控能观的。因此可给系统加上最优控制器,使系统闭环稳定,且满足暂态性能指标。在运用线性二次型最优控制算法进行控制器设计时,主要目的是获得反馈向量置。设计系统的线性二次调节器的关键是对二次型性能指标泛函数中加权矩阵Q和足的选取。通过选择Q和足两个参数可实现对系统的稳定控制。
Q、足的选用原则如下:
1)由于模型是线性化的.为使系统能在线性范围内工作,故两个状态不宜过大;
2)闭环极点最好有一对共轭负极点,有利于克服系统线性摩擦,但主导极点的模又不能太大,否
则系统的频带过宽,对噪声很敏感,不利于系统的正常工作;
第3期王春民,等:倒立摆控制的设计与仿真
245
3)加权矩阵R减小会使控制能量H增加,但//也不能过小,不宜超过系统机构执行能力,以勉导
致放大器处于饱和状态。
为了使问题简化,不妨取Q为对角阵,得到性能指标泛函数
.一
_,=【[Q一;+Q22菇;+Q33茗;+乳石。2+Q舻;+Q酌菇:+Ru2]dt
Ju
(9)
由式(9)可知,Q。是对菇i的平方的加权,Qi的相对增加意味着对毛的要求相对其他状态变量严格,在性能指标中的比重大,茗i的偏差状态相对减小。R是对控制量U的平方加权,当欠相对较大时,意味着控制费用增加,使控制能量较小,反馈减弱;而,取值较小时,系统控制费用减小,反馈增加,系统动态响应迅速。
考虑到主要的被控量为系统的输出量工,0。,05,03,因此在选取加权对角阵Q的各元素值时,由于Q¨代表小车位置的权重,而Q,,是摆杆角度的权重,所以只选取Q为单位阵。足是施加在小车上的
阶跃输入,6个状态量x,o,,05,膏,疗。,如分别代表小车位移、1摆杆位置、2摆杆位置、小车速度、l摆杆角速度和2摆杆角速度,输出Y=[x,0,,02]T包括小车位置、l摆角度和2摆角度。要设计一个控制器,使当给系统施加一个阶跃输入时,摆杆会摆动,然后仍然回到垂直位置,小车到达新的命令位置。
1)确定系统的开环极点为0,0,11.829
4,5.8739,一5.8739,一11.829
4。可以看出,有两个
极点位于s平面的右半部,这说明开环系统不稳定。
2)在取Q=100I,I为单位矩阵,R=l的条件下,得到反馈控制向量K=[10,342.567
508.9042,16.7166,一6.3508,42.093
1,
8]。可以发现,Q矩阵中,增加Q。,使稳定时间和上升时间变
短,并使摆杆的角度变化减小。
3)量纲匹配消除稳态误差。由于输出信号反馈后乘以一个系数矩阵鬈,再与输入量相减得到控制
信号,所以使输入与反馈的量纲不一致。为了使输入与反馈的量纲互相匹配,给输入乘以增益J7\r。加入量纲匹配前后的闭环系统框图如图2和图3所示。
图2未加入量纲匹配的闭环系统
Fig.2Theclosedloopsystem
110
图3加入量纲匹配后的闭环系统
Fig,3
dimensionsuited
Theclosed
loopsystemdimensionsuited
3.1.2
LQY线性二次输出器
rQ。。0
o]
0
与LQR调节器设计类似,但加权矩阵Q,不同,这里
Qy=J
o
Q:2
0
J
1.o
仿真步骤与LQR控制器设计相同。
Q33j
其中Q。。表示小车位移的敏感程度,Q丝表示下摆杆角度敏感程度,Q,,表示上摆杆角度敏感程度。具体
3.2仿真结果分析
LQR和LQY控制效果具体指标如表1所示,比较结果如图4所示。图4中从上到下依次为超调量、摆角1和摆角2的响应曲线。实线是LQY控制的仿真结果,虚线是L.QR控制的仿真结果。
246
吉林大学学报(信息科学版)
第27卷
2
目1
渣
翟0
一lO
.—扣。一
—‘.,一・…・・一‘。‘‘。’。。…。’’一一一一’
2
.time/s
3
…LQR
Conn.oler
‘。。LQYControler
4
5
a超调量响应曲线
堇
o
6
V。
O
,—、
一---LQR
2
time/s
3
4
Controler
A.、.::::;矿
Fig.4Response
curve
b摆角1响应曲线
-・・LQR
Controler
‘。。LQYControler
time/s
c摆角2响应曲线
图4二阶倒立摆线性二次最优控制的响应曲线
ofthesecondorderinvertedpendulumcontrolledby
LQOC
从仿真结果可知,LQR和LQY均能实现对倒立摆系统的稳定控制。LQY输出器具有较优的鲁棒性及瞬态特性,LQR调节器的鲁棒性及瞬态特性较差,但LQR控制器具有较优的稳态特性,LQY输出器
较差。这是因为LQY控制器重点考虑小车位移和摆杆角度在口控制下的变化规律,而LQR是在综合考虑小车位移、摆杆角度、小车速度和摆杆角速度在l,l控制下的反馈规律,所以LQR控制的稳态特性好,
但牺牲了系统的鲁棒性。
4
结
语
线性二次型问题是现代控制理论及应用中最重要的研究领域之一,因线性二次型问题解出的控制规律可通过状态反馈实现闭环最优控制,而成为当今控制工程领域里较为重要的设计方法之一。笔者证明了利用线性二次最优控制理论设计的LQR线性二次调节器和LQY线性二次输出器均能实现对倒立摆系统的控制,而LQY输出器的系统动态性能指标综合较优,这为应用线性二次最优控制理论研究其他问
题提供了理论参考。近代机械控制系统中如直升飞机、导弹控制、火箭发射、人造卫星运行及机器人举重等,都存在着类似倒立摆的稳定控制问题,因此该成果在这些控制系统中也有一定的借鉴意义¨0。。
参考文献:
[1]朱江滨,易建强.二级倒立摆的摆起控制[J].系统仿真学报,2003,15(7):1043—1045.
ZHUJiang-bin,YI
Ji蛐‘qiallg.SwingupControlofDoubleInvertedPendulmnsys咖n[J].JournalofSystemSimulation,
2003,15(7):1043—1045.
第3期王春民,等:倒立摆控制的设计与仿真
247
[2]宋君烈,肖军,徐心和.倒立摆系统的I丑g舢ge方程建模与模糊控制[J].东北大学学报:自然科学版,2002,23
(4):333-337.
SONG
Jun・lie,XIAOJun,XUXin—he.ModelingandFuzzyControlling
on
Lagrange
EquationofInvertedPendulum[J].
JournalofNortheasternUniversity:NaturalScienceEdition,2002,23(4):333-337.
[3]潘健,王俊,汤才刚.基于倒立摆的两种控制策略的研究[J].现代电子技术,2008(1):129.131.
PAN
Jian,WANGJun,TANGCai-gang.Study
on
TwoControlPolicyBased
on
Inverted
Pendulum[J].Modern
Electrionic
Technique,2008(1):129-131.
[4]王良顺,尹平林,代鄂东.基于倒立摆的一种控制器的设计与仿真[J].计算技术与自动化,2006(1):29-31.
WANGLiang-shun,YINPing-lin,DAIE-dong.DesigningandSimulation
ComputationTechnology
on
ControllerBased
on
Inverted
Pendulum[J].
andAutomatization,2006(1):29-31.
[5]张霞,张宁宁,金元郁.基于DSP实现的一阶倒立摆控制[J].微计算机信息,2006,22(17):176-177
ZHANGXia,ZHANG
Ning-ning,JINYuan—yu.Controlof粕Inverted
Pendulum
Based
on
DSP[J].Control&Automation,
2006,22(17):176—177.
[6]么健石,龙德,徐心和.基于动觉图式的平面倒立摆摆起控制[J].东北大学学报:自然科学版,2005,26(6):
531-534.YAO
Jian—shi,LONGDe,XUXin—he.SwingupControlBased
on
SensoryMotor
Schema
forPlanarInverted
Pendulum[J].
JournalofNortheasternUniversity:Natu词ScienceEdition,2005,26(6):531-534.
[7]王春民,刘兴明,嵇艳鞠.连续与离散控制系统[M].北京:科学出版社,2008.
WANGChun—rain,LIUXing—ming,JIYan-ju.ContinuousandDiscreteControlSystem[M].Beijing:SciencePress,2008.
[8]湛力,孙鹏,陈雯柏.倒立摆系统的自摆起和稳定控制[J].计算机仿真,2006,23(8):289-292.
ZHAN
Li,SUNPeIlg,CHEN
Wen—bai.ControlofSwingupandStabilizationofanInvertedPendulum
System[J].Computer
Simulafion,2006,23(8):289-292.
[9]黄金杰,李士勇,左兴权.一种T-s型粗糙模糊控制器的设计与仿真[J].系统仿真学报,2004,16(3):480485.
HUANG
Jin-jie,LIShi-yong,ZUOXing・quan.TheDesignandSimulationof
a
T-STypeofRoughFuzzyController[J].
JournalofSystemSimulation,2004,16(3):480-485.
[10]王芳,周军.二级倒立摆的三种控制方法比较[J].空军工程大学学报:自然科学版,2004,5(2):37-.40.
WANGFang,ZHUOJun.AComparisonStudyofThreeControlsofDoubleInverted
ForceEngineeringUniversity:NaturalScience
Pendulum
System[J].JournalofAir
Edition,2004,5(2):37-40.
(责任编辑:何桂华)