单级倒立摆系统的分析与设计.docx
- 文档编号:24888246
- 上传时间:2023-06-02
- 格式:DOCX
- 页数:15
- 大小:326.99KB
单级倒立摆系统的分析与设计.docx
《单级倒立摆系统的分析与设计.docx》由会员分享,可在线阅读,更多相关《单级倒立摆系统的分析与设计.docx(15页珍藏版)》请在冰豆网上搜索。
单级倒立摆系统的分析与设计
单级倒立摆系统的分析与设计
小组成员:
武锦张东瀛杨姣
李邦志胡友辉
倒立摆系统简介
倒立摆系统是一个典型的高阶次、多变量、不稳定和强耦合的非线性系统。
由于它的行为与火箭飞行以及两足机器人行走有很大的相似性,因而对其研究具有重大的理论和实践意义。
由于倒立摆系统本身所具有的上述特点,使它成为人们深入学习、研究和证实各种控制理论有效性的实验系统。
单级倒立摆系统(SimpleInvertedPendulumSystem)是一种广泛应用的物理模型,其结构和飞机着陆、火箭飞行及机器人的关节运动等有很多相似之处,因
而对倒立摆系统平衡的控制方法在航空及机器人等领域有着广泛的用途,倒立摆
控制理论产生的方法和技术将在半导体及精密仪器加工、机器入技术、导弹拦截
控制系统、航空器对接控制技术等方面具有广阔的开发利用前景。
倒立摆仿真或实物控制实验是控制领域中用来检验某种控制理论或方法的典型方案。
最初研究开始于二十世纪50年代,单级倒立摆可以看作是一个火箭模型,相比之下二阶倒立摆就复杂得多。
1972年,Sturgen等采用线性模拟电路实现了对二级倒立摆的控制。
目前,一级倒立摆控制的仿真或实物系统已广泛用于教学。
系统建模
1•单级倒立摆系统的物理模型
图1:
单级倒立摆系统的物理模型
单级倒立摆系统是如下的物理模型:
在惯性参考系下的光滑水平平面上,放置一个可以在平行于纸面方向左右自由移动的小车(cart),一根刚性的摆杆
(pendulumleg)通过其末端的一个不计摩擦的固定连接点(flexJoint)与小车相连构成一个倒立摆。
倒立摆和小车共同构成了单级倒立摆系统。
倒立摆可以在平行于纸面180°的范围内自由摆动。
倒立摆控制系统的目的是使倒立摆在外力的摄动下摆杆仍然保持竖直向上状态。
在小车静止的状态下,由于受到重力的作用,倒立摆的稳定性在摆杆受到微小的摄动时就会发生不可逆转的破坏而使倒立摆无法复位,这时必须使小车在平行于纸面的方向通过位移产生相应的加速度。
依照惯性参考系下的牛顿力学原理,作用力与物体位移对时间的二阶导数存在线性关系,单级倒立摆系统是一个非线性系统。
各个参数的物理意义为:
M—小车的质量m—倒立摆的质量
F—作用到小车上的水平驱动力L—倒立摆的长度
x—小车的位置9—某一时刻摆角
整个倒立摆系统就受到重力、驱动力和摩擦阻力的三个外力的共同作用。
这
里,驱动力F是由连接小车的传动装置提供,控制倒立摆的稳定实际上就是依靠控制驱动力F使小车在水平面上做与倒立摆运动相关的特定运动。
为了简化模型以利于仿真,假设小车与导轨以及摆杆与小车铰链之间的摩擦均为0o
2•单级倒立摆系统的数学模型
令小车的水平位移为x,运动速度为v,加速度a。
小车的动能为EkC-MX&,
2
选择特定的参考平面使得小车的势能为0o
摆杆的长度为L,某时刻摆角为9,在摆杆上与固定连接点距离为q(Ovqvl)
的位置处取一质量为△m的质兀,则有
xVm
xqsin
yVm
qcos
1
该质元的动能为:
EkVm^Vm/m
yVm)
丄Vm(x^
2
2qcos&&q2&)
势能为:
EpVmVmgqcos,
其中
Vm
dq,卩是摆杆的线密度
则系统的总动能可以通过对和从0到L积分获得:
111
EkVmdq(Mm)&mlcosX&ml
226
l1
Ep0EpVmdq-mglcos
为避免复杂的求解微分方程的运算,考虑摆角在B=0附近的微小变化,倒立摆
在垂直位置可以近似为:
cosB~1,sinB~0,运动方程可简化为:
(mM)&&2ml皱F(t)
善ml2皱1ml(X&g)0
令所有作用力、位移与角度参数为时间t的函数,则
吕[F(t)(mM)&]号(X&g)0
6F(t)6g(mM)
l(m4M)l(m4M)
将相关参数带入,得到
三.控制对象的初步分析
倒立摆系统的基本数据:
M——小车质量2Kg
m摆杆质量0.5Kg
L――摆杆长度0.5m
得到系统的状态方程如下:
&
0
1
0
0
0
&&
34.5882
0
0
0
&
1.4118
x
0
0
0
1
x
u
0
x&
1.7294
0
0
0
&
0.4706
1
0
0
0
&
y
x
0
0
1
0
x
由状态方程可知,系统的开环特征值为:
开环系统有极点在右半平面,因此原系统为不稳定系统
由能控性的定义,根据状态方程&AxBu
S=[BABAA2BAA3B],rank(S)=4,满秩,所以系统完全能控;
由能观性的定义,P=[CCACAA2CAA3]T,
rank(P)=4,满秩,所以系统完全能观。
四.控制器的设计
1.控制方案的选取经典控制理论主要采用频域分析方法,能够很好地解决单输入单输出问题。
单级倒立摆系统的控制对象是一个单输入(力)两输出(角度和位移)的非最小相位系统。
根据对系统的力学分析,应用牛顿第二定律,建立小车在水平方向运动和摆杆旋转运动的方程,并进行线性化,拉氏变换,得出传递函数,从而得到零、极点分布情况。
为使闭环系统能稳定工作,需引入适当的反馈,使闭环系统特征方程的根都位于左平面上。
用经典控制理论的频域分析法设计非最小相位系统的控制器不需要十分精确的对象数学模型。
因为只要控制器使系统具有充分大的相位裕量,就能获得系统参数很宽范围内的稳定性。
与经典控制理论相比,现代控制理论有较强的系统性,从分析到设计、综合都有比较完整的理论和方法。
以单级倒立摆为例,这是一个多变量系统,应用最优状态调节器理论和状态观测器理论的控制思想,控制器采用线性定常状态反馈和观测器的结构。
控制对象(小车、摆杆)分别由传感器检测出两个位置量,然后由观测器重构系统状态,通过状态反馈,组成一个闭环系统,使不稳定系统变为稳定系统,系统的瞬态和静态性能良好。
此外,很多文献介绍了基于输出反馈的PID控制系统,但其控制效果不理想,主要原因是系统的高阶次和多变量。
以及基于模糊神经网络的倒立摆控制系统,该方法由于模糊神经网络系统的自适应能力,有效地克服了系统存在的非线性和不确定性,但该方法过分依赖人直接控制被控对象的经验。
这里我们结合《最优控制》课程的学习,选用基于状态空间设计法的LQR最优调节器,较好地兼顾了系统的稳定性和快速性,应用实例说明了该方法的有效性。
对倒立摆系统进行控制的目的是:
(1)通过状态反馈变不稳定系统为稳定系统;
(2)使系统的瞬态和静态性能良好,系统的调节过程迅速,振荡不要太大。
由前面的分析可知,单级倒立摆系统是不稳定的,但系统的状态是完全可控
和可观的。
根据线性系统控制理论,倒立摆经过适当的状态反馈后,所得到的闭环系统是可以稳定的,并且反馈所需的全部状态可以用状态观测器重构。
具体选
择控制器方案时要考虑:
在保证达到上述控制目标的前提下,控制器的设计和结
构尽可能简单,容易实现。
控制器设计方案如下:
(1)应用确定性系统的控制理论,该系统为确定性系统;
(2)控制规律采用线性定常状态反馈,反馈增益由LQR调节器理论算出;
(3)采用状态观测器重构系统状态。
2•最优调节器设计
线性定常系统的状态反馈增益可由闭环系统的极点配置来确定,也可由最优控制理论计算获得,这里采用后一种方法。
单级倒立摆控制对象模型是一个单输入、双输出系统,它的状态方程为:
XAxBu
设状态反馈调节器的形式为u(k)=—Kx(k),KR1BtP
通过使性能指标函数J=°xT(k)Qx(k)+uT(k)Ru(k)
为最小,
其中,
(1)Q为4*4对称半正定矩阵,R是标量,R>0
(2)矩阵P是Riccati代数方程PAATPPBR1BtPQ0的唯一正定解。
图2:
最优调节器设计
3•状态观测器的设计
采用状态反馈可以更好地改善系统的动态性能指标,然而在实际的控制系统中,并不是所有的状态变量都能够方便测量。
龙伯格状态观测器利用控制对象杜输入变量u和输出变量y对系统的状态变量x进行估计,从而解决某些状态变量不能直接测量的问题,为实现状态反馈提供了可能性。
龙伯格状态观测器的状态方程为:
%(AG*C)%BuGy
式中,u,y是系统可测量的输入与输出
X是待观测杜状态变量的估计值
可见,观测器的实现,关键是确定未知矩阵G
已验证系统是完全能观的,故先化为能观标准型,再进行设计
按照状态观测理论,求得矩阵
33.5882
1.72941
图3:
观测器结构子图
4.二次型性能指标中加权矩阵Q,R的选择
考虑简单情形,把对状态偏差的加权矩阵Q选为对角矩阵,
Q=diag(q1,q2,q3,q4),qi0
qi表示对状态X平方的加权,qi越大表示Xi的偏差在性能指标中占的比重越
大,为使倒立摆稳定,认为摆杆的偏差比小车的偏差影响要小,加权系数取小些。
Q=diag(1,0,50,0)
R=0.1
应用matlab工具函数lqr,可以得到最优控制器对应的反馈增益矩阵K。
K=lqr(A,B,Q,R),求得
K=[-98.7102-17.5043-22.3607-18.4025]
闭环系统的特征值为:
(-5.8583±0.3941i-2.1677±2.0675)
可见,经过状态反馈后系统是稳定的。
五.系统仿真结果
用matlab的simulink工具箱能够方便地实现控制系统的建模与仿真,单级
倒立摆系统的模块框图如下:
给系统施加一个脉冲扰动,先让系统在平衡点处基本稳定,然后在摆杆上加一个
冲击力,迫使系统离开平衡位置,下面是系统在扰动下的仿真曲线:
(1)当加权矩阵Q=diag(1,0,50,0),R=0.1时,
K=[-98.7102-17.5043-22.3607-18.4025]
系统的脉冲响应曲线如下:
揃入控制量
1
!
1
1
1
!
1
1
11
1l>
1I
i»
■.L.
l|
1
i
-"i-_
i
1»
ii
i■
0
1l>
1w
11
1»
i9
■■
1:
--—v--—--r—
■1
i*
-2
■
:
it
1I
1■
I
1
il
1
in
g■
1
」
1
II
L
1■
I1
1
J
■%
1
2
1
456
tims/i
1
8
9!
□
(2)当改变摆杆和小车偏差在性能指标中的比重,
加权矩阵Q=diag(50,0,1,0),R=0.1时,
K=[-71.8393-11.8564-3.1623-5.5273]系统的脉冲响应曲线如下:
(3)当改变控制量输入u在性能指标中的比重,
加权矩阵取为Q=diag(1,0,50,0),R=10时,
K=[-61.5469-10.6515-2.2361-4.1117此时系统的脉冲响应曲线如
下:
輸入控制呈
2IrII1
IRII'V
IIII9
iiiiI
I■■II
II■I*<
1————i:
丄4
012345578910
time/s
(4)系统在随机扰动下的响应曲线:
加权矩阵Q=diag(1,0,50,0),R=0.1
K=[-98.7102-17.5043-22.3607-18.4025]
摆杆的加权系数比小车的加权系数要小,而且输入控制量u的加权系数R越小,
系统的超调量减小,稳定时间变短。
六.讨论与小结
1•系统非线性分析:
单级倒立摆系统的反馈控制规律是应用线性最优控制理论得到的,而在推导
系统的数学模型时一次近似所忽略的系统非线性;此外,未考虑小车、摆杆运动时所受到的摩擦阻力。
这些非线性因素影响了系统性能,因本系统的控制目标只是对其瞬态和稳态行为有控制要求,所以对某些非线性因素可以放宽限制,运用线性控制理论设计可以取得比较满意的结果。
2•加权矩阵Q及R的重要性:
选取不同的Q及R,使得系统对不同的状态及控制量的调节程度不同,同时
影响系统闭环极点的分布和反馈增益。
3•在单级倒立摆的设计过程中,我们采用状态空间设计方法,应用LQR控制器实现了对单级倒立摆的最优控制,应用实例表明该方法的有效性。
而且该方法也适用于其它类似的控制系统。
4•由于数学模型同实际系统有一定差距,使得闭环系统的特征值和仿真结果并
不能完全与真实系统相符合,有时相差很远,所以计算结果需要最后在实际系统上实现,从而决定是否可行。
5•通过完成这次project,实现对单级倒立摆系统的建模、仿真与设计,加深了
对最优控制理论的理解。
我们小组成员相互合作,查阅了很多参考资料,对倒立摆系统有了比较清晰的认识,结合课程的学习,使我们有了更大的收获。
而且学会了使用matlab来实现控制系统的设计与仿真,对我们今后的学习和工作都有很大的帮助。
七.参考资料
【1】《应用最优控制》.吴受章.西安交通大学出版社【2】《近代控制理论的应用实例——二级倒立摆的研制》.冯祖仁【3】基于LQR最优调节器的倒立摆控制系统.黄丹.嵌入式系统应用【4】单级倒立摆系统运动控制方案建模及仿真.吴楠.系统仿真学报【5】《精通MATLAB6》.张航.清华大学出版社
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 倒立 系统 分析 设计