二阶倒立摆实验报告1
直线两级倒立摆实验指导

∂f 2 | . . . .. ∂x x =0,θ1 =0,θ 2 =0, x =0,θ1 =0,θ 2 =0, x =0 ∂f 2 | . . . .. ∂θ 2 x = 0,θ1 =0,θ 2 =0, x =0,θ1 =0,θ 2 =0, x =0
k 22 =
∂f 2 | . . . .. ∂θ1 x =0,θ1 =0,θ 2 =0, x =0,θ1 =0,θ 2 =0, x =0
' '' ' '
对于系统,设以下变量: xpend1 摆杆 1 质心横坐标; yangle1 摆杆 1 质心纵坐标; xpend2 摆杆 2 质心横坐标; yangle2 摆杆 2 质心纵坐标; xmass 质量块质心横坐标; ymass 质量块质心纵坐标; 又有:
©Googol 2005
136
第 6 章 直线两级倒立摆
L( q, q ) = T ( q, q ) − V ( q , q )
. . .
其中 L 为拉格朗日算子,q 为系统的广义坐标,T 为系统的动能,V 为系统的 势能。
d ∂L ∂L − = fi dt ∂ q. ∂qi i
其中 i=1,2,3……n, f i 为系统在第 i 个广义坐标上的外力,在二级倒立摆系统 中,系统的广义坐标有三个广义坐标,分别为 x, θ 1 , θ 2 。 首先计算系统的动能:
©Googol 2005
139
第 6 章 直线两级倒立摆
k11 = ∂x@tD a dd ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. θ1 '@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; k12 = ∂θ1@tD add ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. θ1 '@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; k13 = ∂θ2@tD add ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. θ1 '@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; k14 = ∂x'@tD add ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. a'@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; k15 = ∂θ1'@tD add ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. θ1 '@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; k16 = ∂θ2'@tD add ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. θ1 '@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; k17 = ∂x''@tD add ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. θ1 '@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; k21 = ∂x@tD bdd ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. θ1 '@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; k22 = ∂θ1@tD bdd ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. θ1 '@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; k23 = ∂θ2@tD bdd ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. θ1 '@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; k24 = ∂x'@tD bdd ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. θ1 '@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; k25 = ∂θ1'@tD bdd ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. θ1 '@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; k26 = ∂θ2'@tD bdd ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. θ1 '@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; k27 = ∂x''@tD bdd ê. x@tD → 0 ê. θ1@tD → 0 ê. θ2@tD → 0 ê. x'@tD → 0 ê. θ1 '@tD → 0 ê. θ2'@tD → 0 ê. x''@tD → 0; Simplify@k12D Simplify@k13D Simplify@k17D Simplify@k22D Simplify@k23D Simplify@k27D m1 = 0.05 ; m2 = 0.13; m3 = 0.236; l1 = 0.0775; l2 = 0.25; g = 9.8 ; k12 k13 k17 k22 k23 k27
(最新整理)倒立摆实验报告

的维数,若 r=n,则系统能控,能够进行极点配置。
第二步:受控系统中引入状态反馈向量 K, K k1 kn 。引入状态反
馈向量后系统特征多项式为: f (s) sI ( A BK ) sn a1sn1 an1s an
(11)
设期望特征根为 1*, 2*,, n* ,则期望特征多项式为:
==
(5) (6)
x 0 1 0 0 x 0
x
x
0 0
0 0
0 0
0
x
1
1 0
0 0 29.4 0 3
x
y
x
1 0
0 0
0 1
0 0
x
0 0
(7) (8)
(9)
2 、PID 控制器设计与调节 PID 整定说明: (1)比例(P 作用)增大,系统响应快,对提高稳态精度有益,但过大易
图 4 PID 控制器参数设计界面
1.4 PID 控制器设计
使用 SISO 界面的
添加零点和极
点,使补偿器 C 为 PID 形式。
1
KDS2 + KPS + KI
(1 + aS)(1 + bS)
GPID = KP + KIS + KDS =
S
=k∗
S
(13)
使用 SISO 界面的“Analysis”选项框中 Response to Step Command 的命 令即可查看被控对象阶跃响应曲线。通过调整 SISO 界面添加的零点,同时观察 单位阶跃输入时的闭环响应曲线,寻找合适的 P、I、D 参数。设合适的补偿器 下的根轨迹和参数以及响应曲线如图 5 和图 6:
x (x, x, ,)
倒立摆实验报告建筑结构抗震研究

倒立摆实验报告:建筑结构抗震研究一、引言随着我国经济的快速发展,高层建筑日益增多,建筑结构的抗震性能成为社会关注的焦点。
为了提高建筑物的抗震能力,保障人民生命财产安全,我国政府及相关部门对建筑结构抗震研究给予了高度重视。
本实验报告针对倒立摆实验在建筑结构抗震研究中的应用,分析了倒立摆实验的基本原理、实验方法、实验结果及其在建筑结构抗震研究中的应用前景。
二、倒立摆实验原理倒立摆实验是一种研究建筑结构抗震性能的有效方法。
它利用倒立摆的稳定性原理,模拟地震作用下的建筑物振动响应,从而评估建筑结构的抗震能力。
倒立摆实验系统由摆杆、质量块、基础和支撑装置组成。
当摆杆在一定角度范围内摆动时,质量块产生的惯性力使摆杆保持倒立状态。
通过调整摆杆长度、质量块质量和基础刚度等参数,可以模拟不同建筑结构的抗震性能。
三、实验方法本实验采用数值模拟与实验相结合的方法,研究倒立摆实验在建筑结构抗震研究中的应用。
首先,建立倒立摆实验的数值模型,分析摆杆长度、质量块质量和基础刚度等参数对建筑结构抗震性能的影响。
然后,设计并实施倒立摆实验,验证数值模型的准确性。
最后,根据实验结果,提出提高建筑结构抗震能力的措施。
四、实验结果与分析1.数值模拟结果通过数值模拟,得到了不同参数下建筑结构的抗震性能。
结果表明,摆杆长度、质量块质量和基础刚度对建筑结构的抗震性能有显著影响。
摆杆长度越长,建筑结构的抗震能力越强;质量块质量越大,建筑结构的抗震能力越弱;基础刚度越大,建筑结构的抗震能力越强。
2.实验结果根据实验方案,进行了倒立摆实验。
实验结果表明,倒立摆实验可以有效地模拟建筑结构在地震作用下的振动响应。
通过对比实验结果与数值模拟结果,验证了数值模型的准确性。
同时,实验结果也表明,倒立摆实验可以评估建筑结构的抗震能力,为建筑结构设计提供依据。
五、建筑结构抗震研究展望倒立摆实验作为一种有效的建筑结构抗震研究方法,具有广泛的应用前景。
未来研究方向主要包括:1.进一步优化倒立摆实验系统,提高实验精度和可靠性。
倒立摆实验报告

实验报告姓名:王琳学号:12030078一、控制对象描述本实验的控制对象是二级倒立摆系统,它主要由机电装置和控制装置两部分组成,机电装置的结构主要由小车、两根摆杆及连接轴构成。
假设系统中的每一根摆杆都是匀质刚体,忽略实验中的摩擦力,驱动力与放大器的输入成正比且无延迟地直接作用于小车上。
设定摆杆竖直向上时,下摆杆角位移、上摆杆角位移均为零,摆杆顺时针旋转为正。
下图为二级倒立摆模型。
二、系统建模设x为小车质量,下摆杆质量为M1l1,上摆杆质量为M2,转动惯量为J1,上摆杆重心到转轴b 间的长度l2,小车与地面摩擦力系数f ,下摆杆转轴a 与b 间的长度L ,重力加速度g 。
运用牛顿力学定律建立方程:2212112211222222()()cos ()sin cos sin F f x m M M x M l M l M l M l M l M l ααααββββ∙∙∙∙∙∙∙=+++++-++-222222222222222222222222222sin cos sin sin sin 2sin cos sin cos sin cos cos cos cos J M gl M Ll M Ll M l M l M l x M Ll M Ll M l ββαβααβαββββββαβααβαββ∙∙∙∙∙∙∙∙∙∙=+∙+∙+∙+∙-+∙-∙-∙222221111122222222221111222222222sin sin sin 2sin sin sin sin cos sin sin cos cos cos cos cos sin cos cos J M gl M l M gL M L M L M Ll M Ll M l x M l M L x M L M Ll M Ll ααααααβααααββαββαααααααββαββ∙∙∙∙∙∙∙∙∙∙∙∙∙∙=+∙++∙+∙+∙+∙--∙-∙-∙+∙-∙经过线性化得到如下式子:12112222()()F f x m M M x M l M l M l αβ∙∙∙∙∙∙∙=++++++ 2222222222J M gl M l x M Ll M l ββαβ∙∙∙∙∙∙=---22111211211222()()()J M gl M gL M l M L x M l M L M Ll αααβ∙∙=+-+-+-参数取值:g=9.8;m=1.328;M1=0.22;M2=0.187;l1=0.303;l2=0.2261122334455660100000016.7 1.300.100.70001000039.118.107.90 1.70000010068.514.4025.900.3x x x x x x F x x x x x x ∙∙∙∙∙∙⎡⎤⎢⎥⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥--⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥=+⎢⎥⎢⎥⎢⎥⎢⎥--⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥--⎢⎥⎣⎦⎣⎦⎣⎦⎢⎥⎢⎥⎣⎦ 123456100000001000000010000000100000001000000010x x x x x Y F x x x ααββ∙∙∙⎡⎤⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥==+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦⎢⎥⎣⎦可以得到A 、B 、C 、D :10000016.7 1.300.10000100039.118.107.90000001068.514.425.90A ⎡⎤⎢⎥--⎢⎥⎢⎥=⎢⎥-⎢⎥⎢⎥⎢⎥--⎣⎦00.701.700.3B ⎡⎤⎢⎥⎢⎥⎢⎥=⎢⎥-⎢⎥⎢⎥⎢⎥⎣⎦100000010000001000000100000010000001C ⎡⎤⎢⎥⎢⎥⎢⎥=⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦000000D ⎡⎤⎢⎥⎢⎥⎢⎥=⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦三、系统分析与控制器设计采用线性二次型最优控制器(linearquadraticregulator —LQR)对系统进行控制。
倒立摆实验报告

直线二级倒立摆实验报告目录第1章倒立摆简介 (1)1.1倒立摆设备介绍 (1)第2章直线二级倒立摆的建模及仿真 (2)2.1直线二级倒立摆的数学模型 (2)2.2.1拉格朗日方法建模 (2)2.1.2系统的阶跃响应分析 (4)第3章相关极点设计的MATLAB仿真 (6)3.1远距离的闭环极点仿真 (6)3.2近距离极点的仿真 (6)第4章不同RQ值的MATLAB仿真 (7)4.1不同RQ值仿真 (7)结论 (10)直线二级倒立摆实验报告第1章倒立摆简介1.1 倒立摆设备介绍倒立摆是进行控制理论研究的典型实验平台。
由于倒立摆系统的控制策略和杂技运动员顶杆平衡表演的技巧有异曲同工之处,极富趣味性,而且许多抽象的控制理论概念如系统稳定性、可控性和系统抗干扰能力等等,都可以通过倒立摆系统实验直观的表现出来,因此在欧美发达国家的高等院校,它已成为必备的控制理论教学实验设备。
学习自动控制理论的学生通过倒立摆系统实验来验证所学的控制理论和算法,非常的直观、简便,在轻松的实验中对所学课程加深了理解。
倒立摆不仅仅是一种优秀的教学实验仪器,同时也是进行控制理论研究的理想实验平台。
由于倒立摆系统本身所具有的高阶次、不稳定、多变量、非线性和强耦合特性,许多现代控制理论的研究人员一直将它视为典型的研究对象,不断从中发掘出新的控制策略和控制方法,相关的科研成果在航天科技和机器人学方面获得了广阔的应用。
二十世纪九十年代以来,更加复杂多种形式的倒立摆系统成为控制理论研究领域的热点,每年在专业杂志上都会有大量的优秀论文出现。
深圳市元创兴科技有限公司为高等院校的自动控制教学提供了整套基于倒立摆系统的实验解决方案。
包括各种摆的开发生产、实验内容的安排和配置,以及对应的自动控制理论教学内容和相关经典教材的推荐。
元创兴科技开发生产的倒立摆系列包括直线运动型、圆周运动型和复合倒立摆三个大系列,主要特点包括:开放性:采用四轴运动控制板卡,机械部分和电气部分非常容易扩展,可以根据用户需要进行配置。
工程实例报告1

基于LQR 的二级倒立摆控制一、 问题的描述对于二级倒立摆系统,在外力的作用下如何控制摆的角度在最短的时间内达到系统的平衡。
二、 数学模型的建立建立倒立摆系统的模型时,一般采用牛顿运动规律,结果要解算大量的微分方程组,而且考虑到质点组受到的约束条件,建模问题将更加复杂,为此本报告采用分析力学方法中的Lagrange 方程推导倒立摆的系统模型。
在推导数学模型之前,我们需要几点必要的假设:1.上摆、下摆及小车均是刚体;2.皮带轮与传动带之间无相对滑动;传动皮带无伸长现象;3.小车运动时所受的摩擦力正比于小车的速度;4.小车的驱动力与直流放大器的输入成正比,且无滞后,忽略电机电枢绕组中的电感;5.下摆转动时所受到的摩擦力矩正比于下摆的转动速度;6.上摆运动时所受到的摩擦力矩正比于上摆对下摆的相对角速度; 二级倒立摆的运动分析示意图如图2.2图2.2 二级倒立摆运动分析示意图倒立摆系统参数如下:M =1.32Kg (小车系统的等效质量)1m =0.04Kg (摆杆1质量)1l =0.09m (摆杆1 转动中心到杆质心距离)m 2=0.132Kg (摆杆2 质量)l 2=0.27m (摆杆2 转动中心到杆质心距离)3m =0.208Kg (质量块质量) F :作用在系统上的外力1θ:摆杆1 与垂直向上方向的夹角2θ:摆杆2 与垂直向上方向的夹角首先,计算系统的动能:321m m m M T T T T T +++=(2.3)M T 小车动能:212M T Mx =(2.4)1m T 摆杆1动能:111m mm T T T ''+'= (2.5)式中,'11m T ——摆杆质心平动动能 ''11m T ——摆杆绕质心转动动能 22'111111(sin )(cos )12m d x l d l T m dt dt θθ⎛⎫-⎛⎫⎛⎫=+= ⎪ ⎪ ⎪ ⎪⎝⎭⎝⎭⎝⎭2221111111111cos 22m x m l x m l θθθ-+(2.6) 212112121121''161312121θθω l m l m J T p m =⎪⎭⎫ ⎝⎛==(2.7)则21211111121''1'1132cos 21θθθ l m x l m x m T T T m m m +-=+=(2.8)2m T 摆杆2动能:222m mm T T T ''+'= (2.9)式中,'22m T ——摆杆质心平动动能''22m T ——摆杆绕质心转动动能22'11221122222(2sin sin (2cos cos )1122m d x l l d l l T m m dt dt θθθθ--+⎛⎫⎛⎫=+ ⎪ ⎪⎝⎭⎝⎭()()2221112222111222112cos cos 2sin sin 22m x l l m l l θθθθθθθθ=--++(2.10)2222222222222''261312121θωω l m l m J T m =⎪⎭⎫ ⎝⎛==(2.11)()()'''22222111222122cos cos 2m m m T T T m x x l l θθθθ=+=-+()⎪⎭⎫ ⎝⎛-+++122121222221212cos 434421θθθθθθ l l l l m (2.12)3m T 质量块动能:22111133(2sin )(2cos )12m d x l d l T m dt dt θθ⎛⎫-⎛⎫⎛⎫=+ ⎪ ⎪ ⎪ ⎪⎝⎭⎝⎭⎝⎭2223311131112cos 22m x m l x m l θθθ=-+ (2.13)因此,可以得到系统动能:123M m m m T T T T T =+++222211*********cos 223Mx m x m l x m l θθθ=+-+ ()()22211122cos cos 2221θθθθ l l x x m +-+ ()⎪⎭⎫ ⎝⎛-+++122121222221212cos 434421θθθθθθ l l l l m212131113232cos 221θθθ l m x l m x m +-+ (2.14)系统的势能为:123m m m V V V V =++()11131121122cos 2cos 2cos cos m gl m gl m g l l θθθθ=+++(2.15)至此得到拉格朗日算子L :L T V =-222211*********cos 223Mx m x m l x m l θθθ=+-+ ()()22211122cos cos 2221θθθθ l l x x m +-+()⎪⎭⎫ ⎝⎛-+++122121222221212cos 434421θθθθθθ l l l l m 11121213111323cos 2cos 221θθθθgl m l m x l m x m -+-+()22112113cos cos 2cos 2θθθl l g m gl m +--(2.16)由于因为在广义坐标21,θθ上均无外力作用,有以下等式成立:011=∂∂-⎪⎪⎭⎫ ⎝⎛∂∂θθL L dt d (2.17)022=∂∂-⎪⎪⎭⎫ ⎝⎛∂∂θθL L dt d (2.18)展开(2.17)、(2.18)式,分别得到(2.19)、(2.20)式)cos(2(3))(3(4)sin(61222211321212222θθθθθθθ---+++- l m l m m m l m 0))cos sin ))((2(11321=++++θθxg m m m (2.19)22111222112123sin 6sin()46cos()3cos 0g l l l x θθθθθθθθθ---++--=(2.20) 将(2.19)、(2.20)式对21,θθ 求解代数方程,得到以下两式 21221312111sin )cos(3sin 4sin 4sin 2(3(θθθθθθθ-+---=g m g m gm gm 1122212221212112cos 2)sin(4)sin()cos(6θθθθθθθθθx m l m l m --+--+/))cos )cos(3cos 4cos 422121312θθθθθ-+--xm x m x m)))(cos 912124(2(21223211θθ-+---m m m m l(2.21))cos 3)sin(6sin 3())(3(94(221211222132122θθθθθθx l g l l m m m m ----++--=/)))cos sin ))((2(3)sin(6)(cos(3211321212222212212θθθθθθθx g m m m l m l l m +++---+ ))(cos 4))(3(916(21222212222213212θθ-+++-l l m l l m m m m (2.22)表示成以下形式: ),,,,,,(212111x x x f θθθθθ= (2.23)),,,,,,(212122x x x f θθθθθ=(2.24)取平衡位置时各变量的初值为零,1212(,,,,,,)(0,0,0,0,0,0,0)0A x x x θθθθ===(2.25)将(2.23)式在平衡位置进行泰勒级数展开,并线性化,令 11100A f K x=∂==∂ (2.26) 1231120112313(244)2(4312)A gm gm gm f K m m m l θ=---∂==∂---(2.27) 121302123192(4312)A f m gK m m m l θ=∂==∂---(2.28) 11400A f K x=∂==∂(2.29) 115010A f K θ=∂==∂ (2.30) 116020A f K θ=∂==∂(2.31)123117012313(24)2(4312)A m m m f K xm m m l =---∂==∂---(2.32)得到线性化之后的公式x K K K 172131121++=θθθ(2.33)将),,,,,,(212122x x x f θθθθθ=在平衡位置进行泰勒级数展开,并线性化,令22100A f K x=∂==∂ (2.34)123222012212322(2())164(3())9A g m m m f K m l m m m l θ=++∂==∂-++(2.35)123223022212324(3())163(4(3()))9A g m m m f K m l m m m l θ=++∂==-∂-++ (2.36)22400A f K x =∂==∂ (2.37) 225010A f K θ=∂==∂ (2.38)226020A f K θ=∂==∂(2.39)123123227022123242(2())(3()3164(3())9A m m m m m m f K xm l m m m l =++-++∂==∂-++ (2.40)得到 x K K K 272231222++=θθθ(2.41)即:x K K K 172131121++=θθθ(2.42)x K K K 272231222++=θθθ(2.43)现在得到了两个线性微分方程,由于我们采用加速度作为输入,因此还需加上一个方程:xu = (2.44)取状态变量如下:⎪⎪⎪⎪⎩⎪⎪⎪⎪⎨⎧======2615423121θθθθx x x x x x xx (2.45)则状态空间方程如下:u K K x x x x x x K K K K x x x x x x⎥⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎢⎣⎡+⎥⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎢⎣⎡=⎥⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎢⎣⎡271765432123221312654321100000000000000000100000010000001000(2.46)将以下参数代入 ⎪⎪⎪⎪⎩⎪⎪⎪⎪⎨⎧=======27.009.08.9208.0132.004.032.121321l l g m m m M求出各个K 值:12131777.0642-21.19275.7012K K K === 222327-38.532137.8186-0.0728K K K ===得到状态方程各个参数矩阵:00100000010000001000000077.064221.1927000038.532137.8186000A ⎡⎤⎢⎥⎢⎥⎢⎥=⎢⎥⎢⎥⎢⎥-⎢⎥-⎣⎦⎥⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎢⎣⎡-=0728.07012.51000B 100000010000001000C ⎡⎤⎢⎥=⎢⎥⎢⎥⎣⎦三、LQR 控制器参数Q 、R 的设计一般来说,加权矩阵Q 和R 的选取是在立足提高控制性能与降低控制能量消耗的折衷上考虑的。
倒立摆仿真及实验报告

最优控制实验报告二零一五年一月目录第1章一级倒立摆实验 (3)1.1 一级倒立摆动力学建模 (3)1.1.1 一级倒立摆非线性模型建立 (3)1.1.2 一级倒立摆线性模型建立 (3)1.2 一级倒立摆t∞状态调节器仿真 (3)1.3 一级倒立摆t∞状态调节器实验 (3)1.4 一级倒立摆t∞输出调节器仿真 (3)1.5 一级倒立摆t∞输出调节器实验 (3)1.6 一级倒立摆非零给定调节器仿真 (3)1.7 一级倒立摆非零给定调节器实验 (3)第2章二级倒立摆实验 (3)2.1 二级倒立摆动力学模型 (3)2.1.1 二级倒立摆非线性模型建立 (3)2.1.2 二级倒立摆线性模型建立 (3)2.2 二级倒立摆t∞状态调节器仿真 (3)2.3 二级倒立摆t∞状态调节器实验 (3)2.4 二级倒立摆t∞输出调节器仿真 (3)2.5 二级倒立摆t∞输出调节器实验 (3)2.6 二级倒立摆非零给定调节器仿真 (3)2.7 二级倒立摆非零给定调节器实验 (3)第1章一级倒立摆实验1.1一级倒立摆动力学建模在忽略了空气阻力和各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如图所示图1-1 直线一级倒立摆模型M小车质量 1.096 kg;m 摆杆质量0.109 kg;b 小车摩擦系数0 .1N/m/sec;l 摆杆转动轴心到杆质心的长度0.25m;I 摆杆惯量0.0034 kg·m2;φ摆杆与垂直向上方向的夹角,规定角度逆时针方向为正;x 小车运动位移,规定向右为正。
1.1.1一级倒立摆非线性模型建立采用拉格朗日方法,系统的拉格朗日方程为:()()()=-(1.1),,,L q q T q q V q q其中,L 为拉格朗日算子,q 为系统的广义坐标,T 为系统的动能,V 为系统的势能。
拉格朗日方程由广义坐标i q 和L 表示为:i i id L Lf dt q q ∂∂-=∂∂ (1.2)i f 为系统沿该广义坐标方向上的外力,在本系统中,系统的两个广义坐标分别为φ和x 。
倒立摆实验报告城市轨道交通车辆平衡

倒立摆实验报告:城市轨道交通车辆平衡一、引言随着我国城市化进程的加快,城市轨道交通在缓解交通拥堵、提高居民出行效率方面发挥着重要作用。
作为城市轨道交通系统的重要组成部分,车辆平衡问题直接关系到行车安全和乘客舒适度。
为了确保城市轨道交通车辆在高速行驶过程中的稳定性,本实验采用倒立摆模型对车辆平衡性能进行研究。
本文旨在分析倒立摆实验在城市轨道交通车辆平衡中的应用,以期为我国城市轨道交通车辆设计提供理论依据。
二、实验原理倒立摆实验是一种模拟车辆平衡性能的实验方法,其基本原理是将一个质量较小的摆杆倒立固定在一个质量较大的底座上,通过控制底座的运动,使摆杆保持平衡。
在城市轨道交通车辆中,车辆平衡问题可以类比于倒立摆模型,车辆底部相当于底座,车厢相当于摆杆。
当车辆在曲线上高速行驶时,车厢会受到离心力的作用,容易产生侧翻现象。
通过倒立摆实验,可以研究车辆在不同工况下的平衡性能,为车辆设计提供参考。
三、实验方法本次实验采用一种基于单片机的倒立摆控制系统,主要包括摆杆、底座、电机、编码器、单片机等部分。
实验过程中,通过单片机控制电机的转动,使底座产生相应的运动,从而使摆杆保持平衡。
实验中,我们分别研究了不同速度、不同曲线半径、不同车辆质量等工况下的车辆平衡性能。
四、实验结果与分析1.速度对车辆平衡性能的影响实验结果表明,随着速度的增加,车辆平衡性能逐渐降低。
当速度达到一定程度时,车辆容易出现侧翻现象。
这是因为速度越高,车厢受到的离心力越大,车辆平衡性能越差。
因此,在城市轨道交通车辆设计中,应合理控制车辆的最高运行速度,以确保行车安全。
2.曲线半径对车辆平衡性能的影响实验结果显示,曲线半径越小,车辆平衡性能越差。
这是因为曲线半径越小,车厢受到的离心力越大,车辆越容易产生侧翻。
因此,在城市轨道交通线路设计时,应尽量采用较大的曲线半径,以提高车辆平衡性能。
3.车辆质量对车辆平衡性能的影响实验结果表明,车辆质量越大,车辆平衡性能越好。
倒立摆实验报告

一、实验内容1、完成Matlab Simulink 环境下的电机控制实验。
2、完成直线一级倒立摆的建模、仿真、分析。
3、理解并掌握PID控制的的原理和方法,并应用与直线一级倒立摆4、主要完成状态空间极点配置控制实验、LQR控制实验、LQR控制(能量自摆起)实验、直线二级倒立摆Simulink的实时控制实验。
二、实验设备1、计算机。
2、电控箱,包括交流伺服机驱动器、运动控制卡的接口板、直流电源等。
3、倒立摆本体,包括一级倒立摆,二级倒立摆。
三、倒立摆实验介绍倒立摆是一个典型的不稳定系统,同时又具有多变量、非线性、强耦合的特性,是自动控制理论中的典型被控对象。
它深刻揭示了自然界一种基本规律,即一个自然不稳定的被控对象,运用控制手段可使之具有一定的稳定性和良好的性能。
许多抽象的控制概念如控制系统的稳定性、可控性、系统收敛速度和系统抗干扰能力等,都可以通过倒立摆系统直观的表现出来。
(1)被控对象倒立摆的被控对象为摆杆和小车。
摆杆通过铰链连接在小车上,并可以围绕连接轴自由旋转。
通过给小车施加适当的力可以将摆杆直立起来并保持稳定的状态。
(2)传感器倒立摆系统中的传感器为光电编码盘。
旋转编码器是一种角位移传感器,它分为光电式、接触式和电磁感应式三种,本系统用到的就是光电式增量编码器。
(3)执行机构倒立摆系统的执行机构为松下伺服电机和与之连接的皮带轮。
电机的转矩和速度通过皮带轮传送到小车上,从而带动小车的运动。
电机的驱动由与其配套的伺服驱动器提供。
光电码盘1将小车的位移、速度信号反馈给伺服驱动器和运动控制卡,而光电码盘2 将摆杆的位置、速度信号反馈回控制卡。
计算机从运动控制卡中读取实时数据,确定控制决策(小车向哪个方向移动、移动速度、加速度等),并由运动控制卡来实现该控制决策,产生相应的控制量,使电机转动,带动小车运动,保持摆杆平衡。
图1 直线倒立摆系统总体结构图四、实验步骤4.1 状态空间极点配置控制实验极点配置法通过设计状态反馈控制器将多变量系统的闭环系统极点配置在期望的位置上,从而使系统满足瞬态和稳态性能指标。
倒立摆带降维观测器实验报告

一、实验目的和要求(1)了解倒立摆控制系统的原理和系统组成(2)加深对实际控制系统物理组成部分的认识和理解(3)掌握线性系统控制器的设计、软件算法编制与实现要求针对直线型一级或二级倒立摆系统,设计状态反馈控制器和状态观测器,完成对小车倒立摆的稳定控制。
二、实验内容和原理以直线一级或二级倒立摆为研究对象,开展以下实验内容:(1)系统数学模型建模与分析(2)倒立摆经典控制设计(3)倒立摆状态反馈控制与状态观测器设计(4)倒立摆实物控制调试三、实验项目(1)倒立摆前馈控制起摆研究(2)能量控制起摆研究(3)倒立摆经典控制器设计及调试(4)倒立摆状态反馈控制器设计及调试四、实验器材倒立摆实验系统GLIP 一套计算机(MA TLAB)一台五、操作方法与实验步骤第一种起摆控制(一)模型建立一级倒立摆的模型示意图如下:图1 直线倒立摆一级模型由[1]可得到运动方程:222(cos (cos )()sin cos ()cos ()()()sin ml bx ml ml M m ml u I ml M m M m ml θθθθθθθθθ⋅+-⋅=+⋅+++++222222()()()()sin ()sin cos ()()(cos )I ml M m x I ml bx I ml ml ml g I ml M m u ml xθθθθθ++++-+-⋅=+++可以写成关于θ和x 的微分方程:222()cos ()sin cos ()sin cos (cos )()()M m ml u m M ml mlb x ml ml I ml M m θθθθθθθθ+⋅++-+⋅-++=222222()()()sin ()()sin cos (cos )()()M m I ml u I ml ml I ml bx ml gml I ml M m x θθθθθ-++⋅-+++-⋅-++=由[2]可得到运动方程:2()sin cos I ml mg b ml u θθθθ+=-+⋅根据本次试验对两种模型分别进行了输入输出观察,以[1]中的模型为主进行计算。
倒立摆线性二次型控制实验报告

(3)
x 0 0 Q11 x 0 0 1 ,x ,令 Q ,B 0 0 0 0 0 0 29.4 0 3 0
0 0 ,R=4, 0 Q22 0 0 0 0
设系统的状态方程为
: y Cx
x Ax Bu
x 0 x 0 x , A 0 0
tf
1 0
0 0 1 0 , B , C 1 0 0 0 , 其 性 能 指 标 为 0 0 0 0 0 29.4 0 3 0 0
0
-0.02
-0.04 0
0.5
1
1.5 t(s)
2
2.5
3
图 9
从这两张结果中可以看出, 仿真的效果和上面类比分析的结果不太吻合。 其实, 仔细分析可以发现,Q11 和 Q22 变化时,如果按照严格对应的规则,即 Q11 为小车 的位置权系数,Q22 为摆杆角度的权系数,对应的仿真初始扰动也应该分别为位置
0.3
0.25
0.2 Q11= 100
position(m)
0.15
Q11= 200 Q11= 500 Q11= 1000 Q11= 2000
0.1
0.05
0
-0.05 0
0.5
1
1.5 t(s)
2
2.5
3
图 4
0.1 0.08 0.06 0.04
theta(rad)
0.02 0 -0.02 -0.04 -0.06 0
图 0-1 一级倒立摆的物理模型
其中, M —小车质量, m —摆杆质量, b —小车摩擦系数, l —摆杆转动轴心 到杆质心的长度, I —摆杆惯量, F —加在小车上的力, x —小车位置, —摆杆 与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)。 小车和摆杆的动能分别为
二阶倒立摆实验报告

研究生课程报告二阶倒立摆的控制二阶倒立摆的控制指导老师:屈桢深问题描述小车质量0.8kg,摆杆1质量0.3kg, 摆杆长度1.0m;摆杆2质量0.1kg, 摆杆长度0.5m。
要求:设计NN控制器,满足指标要求:0.2Hz正弦信号幅值裕度<10%, 相角裕度<15度。
同时系统具备抗噪声和干扰性,控制输入合理步骤:1阶倒立摆->2阶倒立摆。
一阶倒立摆建模小车由电机通过同步带驱动在滑杆上来回运动,保持摆杆平衡。
电机编码器和角编码器向运动卡反馈小车和摆杆位置(线位移和角位移)。
小车在轨道上可以自由滑动。
单级倒立摆系统数学模型N 和P 分别为小车与摆杆相互作用力的水平和垂直方向的分量。
分析小车水平方向所受的合力,可得到方程为:N x b F x M --=&&&由摆杆水平方向的受力进行分析可以得到下面等式:()θθθθθsin cos sin 222&&&&&ml ml x m N l x dtd m N -+=+= 把这个等式代入式中,得到系统的第一个运动方程:()F ml ml x b x m M =-+++θθθθsin cos 2&&&&为了推出系统的第二个运动方程,对摆杆垂直方向的合力进行分析,得到下面的方程:()θcos 22l dtd m mg P =-θθθθcos sin 2&&ml ml mg P --=-力矩平衡方程如下:θθ&&I Nl Pl =--cos sin方程中力矩的方向,θφθφsin sin ,cos cos -=-=,故等式前面有负号。
合并这两个方程,约去P 和N ,得到第二个运动方程:()θθθcos sin 2x ml mgl ml I &&&&-=++假设φ与1(单位是弧度)相比很小,即1〈〈φ,则可进行近似处理:0,sin ,1cos 2=⎪⎭⎫⎝⎛-=-=dt d θφθθ用u 代表被控对象的输入力,线性化后两个运动方程如下:()()⎪⎩⎪⎨⎧=-++=-+u ml x b x m M x ml mgl ml I φφφ&&&&&&&&&2 对方程(7)进行拉普拉斯变换,得到:()()⎪⎩⎪⎨⎧=-++=-+)()()()()()()(22222s U s s ml s s bX s s X m M s s mlX s mgl s s ml I φφφ 推导时假设初始条件为0则摆杆角度和小车位移的传递函数为:mgls ml I mls s X s -+=222)()()(φ 摆杆角度和小车加速度之间的传递函数为:()mgls ml I mls A s -+=22)()(φ摆杆角度和小车所受外界作用力的传递函数:22432222()()()()()()ml ss qb I ml M m mgl bmgl F s s s s sq q qq M m I ml m l φ=+++--⎡⎤=++-⎣⎦以外界作用力作为输入的系统状态空间表达式为:22222222220100()00()()0001()00()()0()0()x x I ml b m gl x x I M m Mml I M m Mml mlb mgl M m I M m Mml I M m Mml I ml I M m Mml uml I M m Mml φφφφ⎡⎤⎢⎥⎡⎤⎡⎤-+⎢⎥⎢⎥⎢⎥⎢⎥++++⎢⎥⎢⎥=⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥-+⎣⎦⎣⎦⎢⎥++++⎣⎦⎡⎤⎢⎥+⎢⎥⎢⎥+++⎢⎥⎢⎥⎢⎥⎢⎥++⎣⎦&&&&&&&&1000000100x x x y u φφφ⎡⎤⎢⎥⎡⎤⎡⎤⎡⎤⎢⎥==+⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦⎢⎥⎣⎦&& 以小车加速度作为输入的系统系统状态空间表达式:'010000000100010330044x x x x u g ll φφφφ⎡⎤⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥=+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎢⎥⎢⎥⎣⎦⎣⎦&&&&&&'1000000100x x x y u φφφ⎡⎤⎢⎥⎡⎤⎡⎤⎡⎤⎢⎥==+⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦⎢⎥⎣⎦&& 2系统的可控性、可观测性分析 对于连续时间系统:Bu AX X+=& Du CX y +=系统状态完全可控的条件为:当且仅当向量组BA AB B n 1,...,,-是线性无关的,或n ×n 维矩阵[]BA AB B n 1-M ΛM M的秩为n 。
(完整版)倒立摆实验报告

机械综合设计与创新实验(实验项目一)二自由度平面机械臂三级倒立摆班级:姓名:学号:指导教师:时间:综述倒立摆装置是机器人技术、控制理论、计算机控制等多个领域、多种技术的有结合,被公认为自动控制理论中的典型实验设备,也是控制理论教学和科研中不可多得的典型物理模型。
倒立摆的典型性在于:作为实验装置,它本身具有成本低廉、结构简单、便于模拟、形象直观的特点;作为被控对象,它是一个高阶次、不稳定、多变量、非线性、强耦合的复杂被控系统,可以有效地反映出控制中的许多问题;作为检测模型,该系统的特点与机器人、飞行器、起重机稳钩装置等的控制有很大的相似性[1]。
倒立摆系统深刻揭示了自然界一种基本规律,即一个自然不稳定的被控对象,运用控制手段可使之具有良好的稳定性。
通过对倒立摆系统的研究,不仅可以解决控制中的理论问题,还能将控制理论所涉及的三个基础学科,即力学、数学和电学(含计算机)有机的结合起来,在倒立摆系统中进行综合应用。
在多种控制理论与方法的研究和应用中,特别是在工程实践中,也存在一种可行性的试验问题,将其理论和方法得到有效的经验,倒立摆为此提供一个从控制理论通往实践的桥梁[2]。
因此对倒立摆的研究具有重要的工程背景和实际意义。
从驱动方式上看,倒立摆模型大致可分为直线倒立摆模型、旋转倒立摆模型和平面倒立摆模型。
对于每种模型,从摆杆的级数上又可细分为一级倒立摆、二级倒立摆和多级倒立摆[3]。
目前,国内针对倒立摆的研究主要集中在运用倒立摆系统进行控制方法的研究与验证,特别是针对利用倒立摆系统进行针对于非线性系统的控制方法及理论的研究。
而倒立摆系统与工程实践的结合主要体现在欠驱动机构控制方法的验证之中。
此外,倒立摆作为一个典型的非线性动力系统,也被用于研究各类非线性动力学问题。
在倒立摆系统中成功运用的控制方法主要有线性控制方法,预测控制方法及智能控制方法三大类。
其中,线性控制方法包括PID控制、状态反馈控和LQR 控制等;预测控制方法包括预测控制、分阶段起摆、变结构控制和自适应神经模糊推理系统等,也有文献将这些控制方法归类为非线性控制方法;智能控制方法主要包括神经网络控制、模糊控制、遗传算法、拟人智能控制、云模型控制和泛逻辑控制法等。
二阶倒立摆实验报告.doc

ml2(s) s2
mgl (s)
mlX ( s)s2
M
m X (s)s2
bX (s) s
ml ( s)s2
U (s)
推导时假设初始条件为0则摆杆角度和小车位移的传递函数
为:
(s)mls2
X (s)(Iml2) s2mgl
摆杆角度和小车加速度之间的传递函数为:
( s)ml
A(s)Iml2s2mgl
摆杆角度和小车所受外界作用力的传递函数:
Mml2
I (M
m)
Mml2
I ( M
0
I
ml2
I (M
m)
Mml2
0
u
ml
I (M
m)
Mml2
x
x
1
0
0
&
0
y
0 x
u
0
0
1
0
0
&
以小车加速度 作为输入的系统系统状态空间表达式:
&
0
1
0
0
x
0
x
0
0
0
0
1
&&x
x&
u'
0
0
0
1
0
&
0
0
3g
0
&
3
4l
4l
x
x
1
0
0
0
&
0
y
x
u'
0
0
1
0
0
&
2系统的可控性、可观测性分析
2cos2
x
(完整版)倒立摆实验报告(PID控制)

专业实验报告3. 实验装置直线单级倒立摆控制系统硬件结构框图如图1所示,包括计算机、I/O设备、伺服系统、倒立摆本体和光电码盘反馈测量元件等几大部分,组成了一个闭环系统。
图1 一级倒立摆实验硬件结构图对于倒立摆本体而言,可以根据光电码盘的反馈通过换算获得小车的位移,小车的速度信号可以通过差分法得到。
摆杆的角度由光电码盘检测并直接反馈到I/O设备,速度信号可以通过差分法得到。
计算机从I/O设备中实时读取数据,确定控制策略(实际上是电机的输出力矩),并发送给I/O设备,I/O设备产生相应的控制量,交与伺服驱动器处理,然后使电机转动,带动小车运动,保持摆杆平衡。
图2是一个典型的倒立摆装置。
铝制小车由6V的直流电机通过齿轮和齿条机构来驱动。
小车可以沿不锈钢导轨做往复运动。
小车位移通过一个额外的与电机齿轮啮合的齿轮测得。
小车上面通过轴关节安装一个摆杆,摆杆可以绕轴做旋转运动。
系统的参数可以改变以使用户能够研究运动特性变化的影响,同时结合系统详尽的参数说明和建模过程,我们能够方便地设计自己的控制系统。
图2 一级倒立摆实验装置图上面的倒立摆控制系统的主体包括摆杆、小车、便携支架、导轨、直流伺服电机等。
主图7 直线一级倒立摆PD控制仿真结果图从上图可以看出,系统在1.5秒后达到平衡,但是存在一定的稳态误差。
为消除稳态误差,我们增加积分参数Ki,令Kp=40,Ki=60,Kd=2,得到以下仿真结果:图8 直线一级倒立摆PID控制仿真结果图从上面仿真结果可以看出,系统可以较好的稳定,但由于积分因素的影响,稳定时间明显增大。
双击“Scope1”,得到小车的位置输出曲线为:图9 施加PID控制器后小车位置输出曲线图由于PID 控制器为单输入单输出系统,所以只能控制摆杆的角度,并不能控制小车的位置,所以小车会往一个方向运动,PID控制分析中的最后一段,若是想控制电机的位置,使得倒立摆系统稳定在固定位置附近,那么还需要设计位置PID闭环。
倒立摆实验报告建筑起重机械稳定性分析

建筑起重机械稳定性分析——倒立摆实验报告一、引言随着我国经济的快速发展,建筑行业取得了举世瞩目的成就。
在高层建筑、大型基础设施等项目中,起重机械发挥着举足轻重的作用。
然而,起重机械在施工现场的安全事故时有发生,其中稳定性问题尤为突出。
为了提高起重机械的稳定性,降低事故风险,本文以倒立摆实验为研究对象,分析建筑起重机械的稳定性问题,并提出相应的改进措施。
二、实验原理与方法1.实验原理倒立摆实验是一种研究物体在重力作用下保持稳定的实验方法。
在本实验中,将起重机械简化为倒立摆模型,通过改变摆长、摆重等参数,研究起重机械在受到外部扰动时的稳定性。
2.实验方法(1)搭建实验装置:采用一根细杆作为摆杆,一端固定,另一端悬挂重物,模拟起重机械的吊臂和吊重。
(2)测量摆长:通过测量摆杆长度,确定摆长参数。
(3)施加外部扰动:在摆杆上施加不同大小的横向力,模拟施工现场的外部扰动。
(4)观察摆动情况:记录摆杆在受到外部扰动时的摆动幅度和摆动周期,分析稳定性变化。
三、实验结果与分析1.摆长对稳定性的影响实验结果显示,摆长越长,起重机械的稳定性越差。
这是因为摆长越长,摆动周期越长,抵抗外部扰动的能力减弱。
因此,在设计起重机械时,应合理选择吊臂长度,以提高稳定性。
2.摆重对稳定性的影响实验结果显示,摆重越大,起重机械的稳定性越好。
这是因为摆重越大,摆杆受到的外部扰动产生的摆动幅度越小。
因此,在施工现场,应合理配置吊重,提高起重机械的稳定性。
3.外部扰动对稳定性的影响实验结果显示,外部扰动越大,起重机械的稳定性越差。
这是因为外部扰动会破坏起重机械的平衡状态,导致摆动幅度增大。
因此,在施工现场,应尽量减少外部扰动,确保起重机械的稳定性。
四、改进措施与建议1.优化设计参数根据实验结果,合理选择吊臂长度和吊重,以提高起重机械的稳定性。
在设计过程中,可以采用现代设计方法,如有限元分析、优化算法等,寻找最佳设计参数。
2.提高制造质量加强起重机械制造过程的质量控制,确保零部件的精度和强度。
倒立摆实验报告

《线性系统理论》课程——倒立摆实验报告基本情况实验完成了基本要求,通过pid、极点配置、根轨迹、和ldr方法调试运行一级倒立摆,设计新的pid参数,调试运行状态,逐渐使一级倒立摆稳定,完成了实验的基本要求。
在对一级倒立摆完成实验的基础上,进一步对二级倒立摆进行了分析研究。
这其中的工作主要包括针对LDR方法运行demo,观察系统稳定性,快速性,调整系统参数,查看有什么问题,并且针对问题提出修改意见。
在多次试验后,对系统有了进一步的了解,便开始着手二级倒立摆极点配置方法的实现问题。
这部分继续学习了极点配置的方法,通过编写m文件,计算K,仿真运行系统,查看系统图像,查看调节时间,超调量等。
逐渐调试参数,使系统指标顺利达到。
最后是进行试验,进一步调整系统参数。
在这一个过程中,经验很重要,同时偶然因素也起到了重要的作用。
所以调试一个系统真的不容易。
这一部分的内容在第六节中进行了较为详细的介绍收获对倒立摆的系统原理有了更深层次的了解掌握了pid、极点配置、根轨迹、ldr方法设计系统学会了一些调试运行系统的经验加强了和同学之间的交流,锻炼了软件实现编程能力改进意见这里我有一个小小的建议,这是我在做实验的时候遇到了问题总结。
系统参数含义还不是很清楚。
在这个方面尤其是参数对应着系统的具体实际含义不明确,只能在尝试凑参数,有时出现了一个问题,不知道是哪个参数引起的,所以影响了效率,结果也不是很明显。
改进意见:共有四次实验,第一次实验安排不变但是试验后,负责人要收集问题,主要是要老师来解决的,在第二次实验前针对上一次的问题进行集体讲解一下,尤其是与物理的联系,不要仅仅是自己做实验吧,第三次和第一次相同,第四次与第二次相同。
在这个完成后,如果课堂有时间,可以进行了一个小小的试验心得介绍,和大家交流心得体会。
或者是老师统一解决一下这个总体过程中的问题,我觉得这样结果会更好一点。
下面是具体的详细报告一、倒立摆系统介绍倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
线性系统实验报告姓名:院系:航天学院学号:2015年12月1.实验目的1)熟悉Matlab/Simulink仿真;2)掌握LQR控制器设计和调节;3)理解控制理论在实际中的应用。
倒立摆研究的意义是,作为一个实验装置,它形象直观,简单,而且参数和形状易于改变;但它又是一个高阶次、多变量、非线性、强耦合、不确定的绝对不稳定系统的被控系统,必须采用十分有效的控制手段才能使之稳定。
因此,许多新的控制理论,都通过倒立摆试验对理论加以实物验证,然后在应用到实际工程中去。
因此,倒立摆成为控制理论中经久不衰的研究课题,是验证各种控制算法的一个优秀平台,故通过设计倒立摆的控制器,可以对控制学科中的控制理论有一个学习和实践机会。
2.实验内容1)建立直线二级倒立摆数学模型对直线二级倒立摆进行数学建模,并将非线性数学模型在一定条件下化简成线性数学模型。
对于倒立摆系统,由于其本身是自不稳定的系统,实验建立模型存在一定的困难,但是经过小心的假设忽略掉一些次要的因素后,倒立摆系统就是一个典型的运动的刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。
对于直线二级倒立摆,由于其复杂程度,在这里利用拉格朗日方程推导运动学方程。
由于模型的动力学方程中存在三角函数,因此方程是非线性的,通过小角度线性化处理,将动力学非线性方程变成线性方程,便于后续的工作的进行。
2)系统的MATLAB仿真依据建立的数学模型,通过MATLAB仿真得出系统的开环特性,采取相应的控制策略,设计控制器,再加入到系统的闭环中,验证控制器的作用,并进一步调试。
控制系统设计过程中需要分析内容主要包括得出原未加控制器时系统的极点分布,系统的能观性,能控性。
3)LQR 控制器设计与调节实验利用线性二次型最优(LQR )调节器MATLAB 仿真设计的参数结果对平面二阶倒立摆进行实际控制实验,参数微调得到较好的控制效果,记录实验曲线。
4)改变控制对象的模型参数实验调整摆杆位置,将摆杆1朝下,摆杆2朝上修改模型参数、起摆条件和控制参数,重复3的内容。
3. 实验步骤1)倒立摆系统模型在忽略了空气流动,各种摩擦之后,可将倒立摆系统抽象成小车、匀质杆和质量块组成的系统,如图1所示。
图1 直线两级倒立摆物理模型下面利用拉格朗日方程推导运动学方程。
拉格朗日方程为: ()()(),,,L q qT q q V q q =- (1)i d L Lf dt qq δδδδ-= (2)123M m m m T T T T T =+++(3)111m mm T T T '''=+ (4) 222m mm T T T '''=+ (5)212M T Mx =(6)()()2211111122211111111sin sin 1211cos 22m d x l d l T m dt dt m x m l x m l θθθθθ⎛⎫-⎛⎫⎛⎫ ⎪'=+ ⎪ ⎪ ⎪⎝⎭⎝⎭⎝⎭=-+ (7)222221111111111112236mp T J m l m l ωθθ⎛⎫''=== ⎪⎝⎭(8)则'''2221111111111112cos 23m m m T T T m x m l x m l θθθ=+=-+(9)同样可以求出()()22'112211222222221112222111222(2sin sin (2cos cos )1122112cos cos 2sin sin 22m d x l l d l l Tm m dt dt m x l l m l l θθθθθθθθθθθθ--+⎛⎫⎛⎫=+ ⎪ ⎪⎝⎭⎝⎭=--++(10)''2222222222222211112236m T J m l m l ωωθ⎛⎫=== ⎪⎝⎭(11)()()()'''22222111222222221122121221122cos cos 21444cos 23m m m T T T m x x l l m l l l l θθθθθθθθθθ=+=-+⎛⎫+++- ⎪⎝⎭(12)2211113322233111311(2sin )(2cos )1212cos 22m d x l d l T m dt dt m x m l x m l θθθθθ⎛⎫-⎛⎫⎛⎫=+ ⎪ ⎪ ⎪ ⎪⎝⎭⎝⎭⎝⎭=-+ (13)因此,可以得到系统的总动能为:()()()1232222111111112211122222222112212122122233111311112cos 223122cos cos 21444cos 2312cos 22M m m m T T T T T Mx m x m l x m l m x x l l m l l l l m x m l x m l θθθθθθθθθθθθθθθθ=+++=+-++-+⎛⎫+++- ⎪⎝⎭+-+ (14)系统的总势能为:()12311131121122cos 2cos 2cos cos m m m V V V V m gl m gl m g l l θθθθ=++=+++ (15)从而拉格朗日算子:()()()2222111111112211122222222112212122122233111311111311211112cos 223122cos cos 21444cos 2312cos 2cos 22cos 2cos L T V Mx m x m l x m l m x x l l m l l l l m x m l x m l m gl m gl m g l θθθθθθθθθθθθθθθθθθθ=-=+-++-+⎛⎫+++- ⎪⎝⎭+-+--- ()22cos l θ+(16)由于因为在广义坐标21,θθ上均无外力作用,有以下等式成立:110d L Ldt θθ⎛⎫∂∂-= ⎪∂∂⎝⎭ (17)220d L Ldt θθ⎛⎫∂∂-= ⎪∂∂⎝⎭ (18)展开(17),(18)式,分别得到(19),(20)式2222121231122221123116sin()4(3())3(2cos()(2())(sin cos ))0m l m m m l m l m m m g x θθθθθθθθθ-+++---++++= (19)22111222112123sin 6sin()46cos()3cos 0g l l l x θθθθθθθθθ---++--= (20)将(19),(20)式对21,θθ 求解代数方程,得到以下两式111213122122221121212212211213121222112321(3(2sin 4sin 4sin 3cos()sin 6cos()sin()4sin()2cos 4cos 4cos 3cos()cos ))/(2(412129cos (gm gm m g m g m l m l m x m x m x m x l m m m m θθθθθθθθθθθθθθθθθθθθθθ=---+-+--+----+----+- 2)))θ(21)22221231221112222212122221212311222222212312212124((3())(3sin 6sin()3cos )92cos()(6sin()3(2())(sin cos )))/316((3())4cos ())9m m m m l l g l x m l l m l m m m g x m m m m l l m l l θθθθθθθθθθθθθθθ=--++----+---+++-+++-(22)表示成以下形式:111212(,,,,,,)f x x x θθθθθ= (23)221212(,,,,,,)f x x x θθθθθ=(24)取平衡位置时各变量的初值为零,1212(,,,,,,)(0,0,0,0,0,0,0)0A x x x θθθθ===(25)将(23)式在平衡位置进行泰勒级数展开,并线性化,令:11100A f K x=∂==∂ (26)1231120112313(244)2(4312)A gm gm gm f K m m m l θ=---∂==∂---(27)121302123192(4312)A f m gK m m m l θ=∂==∂---(28)11400A f K x=∂==∂(29)115010A f K θ=∂==∂ (30)116020A f K θ=∂==∂ (31)123117012313(24)2(4312)A m m m f K xm m m l =---∂==∂---(32)带入(21)式,得到线性化之后的公式112113217K K K x θθθ=++(33)将(24)式在平衡位置进行泰勒级数展开,并线性化,令22100A f K x=∂==∂ (34)123222012212322(2())164(3())9A g m m m f K m l m m m l θ=++∂==∂-++ (35)123223022212324(3())3(4(3()))9A g m m m fK m l m m m l θ=++∂==-∂-++ (36)22400A f K x=∂==∂ (37)225010A f K θ=∂==∂ (38)226020A f K θ=∂==∂ (39)123123227022123242(2())(3()3164(3())9A m m m m m m f K x m l m m m l =++-++∂==∂-++(40)带入(22)式,得到222123227K K K x θθθ=++ (41)即:112113217K K K x θθθ=++ (42)222123227K K K x θθθ=++(43)现在得到了两个线性微分方程,由于我们采用加速度作为输入,因此还需加上一个方程u x = (44)取状态变量如下:1213245162x x x x x x x x θθθθ=⎧⎪=⎪⎪=⎪⎨=⎪⎪=⎪=⎪⎩ (45)由(33),(41),(42)式得到状态空间方程如下:112233445121351762223627000100000001000000010000000100000000x x x x x x u x x x K K x K x K K x K ⎡⎤⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥=+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦⎣⎦(46)其中直线两级倒立摆系统参数为:M小车质量 2.32kg 1m 摆杆1质量 0.04kg 2m摆杆2质量 0.132kg 3m质量块质量 0.208kg1θ摆杆1与垂直向上方向的夹角 2θ摆杆2与垂直向上方向的夹角 1l 摆杆1到转动中心质心的距离 0.09m 2l摆杆1到转动中心质心的距离 0.27m F作用在系统上的外力由以上方程,将以下参数代入12312 1.320.040.1320.2089.80.090.27M m m m g l l =⎧⎪=⎪⎪=⎪=⎨⎪=⎪=⎪⎪=⎩ (47)求出各个K 值:12221323172777.0642-38.5321-21.192737.81865.7012-0.0728K K K K K K ====== (48)得到状态矩阵为: A =0 0 0 1.0000 0 0 0 0 0 0 1.0000 0 0 0 0 0 0 1.0000 0 0 0 0 0 0 0 86.6907 -21.6172 0 0 0 0 -40.3112 39.4500 0 0 0 B = 0 0 0 1.0000 6.6402 -0.0877 C =1 0 0 0 0 0 0 1 0 0 0 0 0 0 1 0 0 0 0 0 0 1 0 0 0 0 0 0 1 00 0 0 0 0 1D=[0 0 0 0 0 0]'2)根据建模结果仔细计算并寻找合适的理论控制器参数。