二阶倒立摆实验报告材料

合集下载

直线两级倒立摆实验指导

直线两级倒立摆实验指导

∂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

倒立摆实验报告建筑结构抗震研究

倒立摆实验报告建筑结构抗震研究

倒立摆实验报告:建筑结构抗震研究一、引言随着我国经济的快速发展,高层建筑日益增多,建筑结构的抗震性能成为社会关注的焦点。

为了提高建筑物的抗震能力,保障人民生命财产安全,我国政府及相关部门对建筑结构抗震研究给予了高度重视。

本实验报告针对倒立摆实验在建筑结构抗震研究中的应用,分析了倒立摆实验的基本原理、实验方法、实验结果及其在建筑结构抗震研究中的应用前景。

二、倒立摆实验原理倒立摆实验是一种研究建筑结构抗震性能的有效方法。

它利用倒立摆的稳定性原理,模拟地震作用下的建筑物振动响应,从而评估建筑结构的抗震能力。

倒立摆实验系统由摆杆、质量块、基础和支撑装置组成。

当摆杆在一定角度范围内摆动时,质量块产生的惯性力使摆杆保持倒立状态。

通过调整摆杆长度、质量块质量和基础刚度等参数,可以模拟不同建筑结构的抗震性能。

三、实验方法本实验采用数值模拟与实验相结合的方法,研究倒立摆实验在建筑结构抗震研究中的应用。

首先,建立倒立摆实验的数值模型,分析摆杆长度、质量块质量和基础刚度等参数对建筑结构抗震性能的影响。

然后,设计并实施倒立摆实验,验证数值模型的准确性。

最后,根据实验结果,提出提高建筑结构抗震能力的措施。

四、实验结果与分析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)对系统进行控制。

倒立摆实验报告(现代控制理论)

倒立摆实验报告(现代控制理论)

现代控制理论实验报告——倒立摆小组成员:指导老师:2013.5实验一建立一级倒立摆的数学模型一、实验目的学习建立一级倒立摆系统的数学模型,并进行Matlab仿真。

二、实验内容写出系统传递函数和状态空间方程,用Matlab进行仿真。

三、Matlab源程序及程序运行的结果(1)Matlab源程序见附页(2)给出系统的传递函数和状态方程(a)传递函数gs为摆杆的角度:>> gsTransfer function:2.054 s-----------------------------------s^3 + 0.07391 s^2 - 29.23 s - 2.013(b)传递函数gspo为小车的位移传递函数:>> gspoTransfer function:0.7391 s^2 - 20.13---------------------------------------s^4 + 0.07391 s^3 - 29.23 s^2 - 2.013 s(c)状态矩阵A,B,C,D:>> sysa =x1 x2 x3 x4x1 0 1 0 0x2 0 -0.07391 0.7175 0x3 0 0 0 1x4 0 -0.2054 29.23 0b =u1x1 0x2 0.7391x3 0x4 2.054c =x1 x2 x3 x4y1 1 0 0 0y2 0 0 1 0d =u1y1 0y2 0Continuous-time model.(3)给出传递函数极点和系统状态矩阵A的特征值(a)传递函数gs的极点>> PP =5.4042-5.4093-0.0689(b)传递函数gspo的极点>> PoPo =5.4042-5.4093-0.0689(c)状态矩阵A的特征值>> EE =-0.06895.4042-5.4093(4)给出系统开环脉冲响应和阶跃响应的曲线(a)开环脉冲响应曲线(b)阶跃响应曲线四、思考题(1)由状态空间方程转化为传递函数,是否与直接计算传递函数相等?答:由状态空间方程转化为传递函数:>> gso=tf(sys)Transfer function from input to output...0.7391 s^2 - 6.565e-016 s - 20.13#1: ---------------------------------------s^4 + 0.07391 s^3 - 29.23 s^2 - 2.013 s2.054 s + 4.587e-016#2: -----------------------------------s^3 + 0.07391 s^2 - 29.23 s - 2.013#1为gspo传递函数,#2为gs的传递函数而直接得到的传递函数为:>> gspoTransfer function:0.7391 s^2 - 20.13---------------------------------------s^4 + 0.07391 s^3 - 29.23 s^2 - 2.013 s>> gsTransfer function:2.054 s-----------------------------------s^3 + 0.07391 s^2 - 29.23 s - 2.013通过比较可以看到,gspo由状态空间方程转化的传递函数比直接得到的传递函数多了s的一次项,而6.565e-016非常小几乎可以忽略不计,因此可以认为两种方法得到的传递函数式相同的,同理传递函数gs也可以认为是相同的。

倒立摆实验报告

倒立摆实验报告

直线二级倒立摆实验报告目录第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 倒立摆设备介绍倒立摆是进行控制理论研究的典型实验平台。

由于倒立摆系统的控制策略和杂技运动员顶杆平衡表演的技巧有异曲同工之处,极富趣味性,而且许多抽象的控制理论概念如系统稳定性、可控性和系统抗干扰能力等等,都可以通过倒立摆系统实验直观的表现出来,因此在欧美发达国家的高等院校,它已成为必备的控制理论教学实验设备。

学习自动控制理论的学生通过倒立摆系统实验来验证所学的控制理论和算法,非常的直观、简便,在轻松的实验中对所学课程加深了理解。

倒立摆不仅仅是一种优秀的教学实验仪器,同时也是进行控制理论研究的理想实验平台。

由于倒立摆系统本身所具有的高阶次、不稳定、多变量、非线性和强耦合特性,许多现代控制理论的研究人员一直将它视为典型的研究对象,不断从中发掘出新的控制策略和控制方法,相关的科研成果在航天科技和机器人学方面获得了广阔的应用。

二十世纪九十年代以来,更加复杂多种形式的倒立摆系统成为控制理论研究领域的热点,每年在专业杂志上都会有大量的优秀论文出现。

深圳市元创兴科技有限公司为高等院校的自动控制教学提供了整套基于倒立摆系统的实验解决方案。

包括各种摆的开发生产、实验内容的安排和配置,以及对应的自动控制理论教学内容和相关经典教材的推荐。

元创兴科技开发生产的倒立摆系列包括直线运动型、圆周运动型和复合倒立摆三个大系列,主要特点包括:开放性:采用四轴运动控制板卡,机械部分和电气部分非常容易扩展,可以根据用户需要进行配置。

线性系统倒立摆实验(5篇材料)

线性系统倒立摆实验(5篇材料)

线性系统倒立摆实验(5篇材料)第一篇:线性系统倒立摆实验直线倒立摆控制及一级正摆位移和角度控制一、实验目的(1)在Matlab Simulink环境下实现控制伺服电机;(2)完成直线倒立摆建模、仿真与分析;(3)通过控制器设计使倒立摆系统稳定运行(摆角保持零度附近):二、实验内容及要求(1)状态空间极点配置控制实验(一组极点为书上指定,任选另一组,但保证控制效果要好于前者)具体记录要求:在稳定后(先截一张图),叠加一扰动(仅角度扰动),记录消除扰动的过程(再截一张图),同时记录你所选择的期望极点组。

(2)线性二次最优控制LQR 控制实验(R,Q选择为书上指定,任选另一组,但保证控制效果要好于前者)具体记录要求:在稳定后(先截一张图),叠加一扰动(仅角度扰动),记录消除扰动的过程(再截一张图),同时记录你所选择的R,Q取值。

(3)一级正摆位移和角度控制借助于正摆实验平台,构思、设计控制策略和控制算法,并编程实现,通过实验设备将物体快速、准确地运输到指定的位置,且在吊运的整个过程(起吊,运输,到达目的地)保持较小的摆动角。

要求:系统启动后,在当前位置给正摆施加一角度扰动,当平衡(摆角为零)后,让小车直线运行30厘米,并快速保证平衡(摆角为零)。

三、实验过程1.实验方法(1)Matlab Simulink仿真环境下精确控制电机在MATLAB Simulink仿真环境中,建立模型,然后进行仿真并分析结果。

(2)直线倒立摆建模、仿真与分析利用牛顿力学进行受力分析,然后建立直线一级倒立摆系统的数学模型;进行仿真分析。

(3)状态空间极点配置控制实验进入MATLAB Simulink 实时控制工具箱“Googol Education Products”打开“Inverted PendulumLinear Inverted PendulumLinear 1-Stage IP Experiment PolesExperiments”中的“Poles Control M File1”。

倒立摆实验报告

倒立摆实验报告

《线性系统理论》课程——倒立摆实验报告基本情况实验完成了基本要求,通过pid、极点配置、根轨迹、和ldr方法调试运行一级倒立摆,设计新的pid参数,调试运行状态,逐渐使一级倒立摆稳定,完成了实验的基本要求。

在对一级倒立摆完成实验的基础上,进一步对二级倒立摆进行了分析研究。

这其中的工作主要包括针对LDR方法运行demo,观察系统稳定性,快速性,调整系统参数,查看有什么问题,并且针对问题提出修改意见。

在多次试验后,对系统有了进一步的了解,便开始着手二级倒立摆极点配置方法的实现问题。

这部分继续学习了极点配置的方法,通过编写m文件,计算K,仿真运行系统,查看系统图像,查看调节时间,超调量等。

逐渐调试参数,使系统指标顺利达到。

最后是进行试验,进一步调整系统参数。

在这一个过程中,经验很重要,同时偶然因素也起到了重要的作用。

所以调试一个系统真的不容易。

这一部分的内容在第六节中进行了较为详细的介绍收获对倒立摆的系统原理有了更深层次的了解掌握了pid、极点配置、根轨迹、ldr方法设计系统学会了一些调试运行系统的经验加强了和同学之间的交流,锻炼了软件实现编程能力改进意见这里我有一个小小的建议,这是我在做实验的时候遇到了问题总结。

系统参数含义还不是很清楚。

在这个方面尤其是参数对应着系统的具体实际含义不明确,只能在尝试凑参数,有时出现了一个问题,不知道是哪个参数引起的,所以影响了效率,结果也不是很明显。

改进意见:共有四次实验,第一次实验安排不变但是试验后,负责人要收集问题,主要是要老师来解决的,在第二次实验前针对上一次的问题进行集体讲解一下,尤其是与物理的联系,不要仅仅是自己做实验吧,第三次和第一次相同,第四次与第二次相同。

在这个完成后,如果课堂有时间,可以进行了一个小小的试验心得介绍,和大家交流心得体会。

或者是老师统一解决一下这个总体过程中的问题,我觉得这样结果会更好一点。

下面是具体的详细报告一、倒立摆系统介绍倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。

倒立摆仿真报告

倒立摆仿真报告

计算机控制系统课题报告1.倒立摆基本背景:倒立摆,Inverted Pendulum ,是典型的多变量、高阶次,非线性、强耦合、自然不稳定系统。

倒立摆系统的稳定控制是控制理论中的典型问题,在倒立摆的控制过程中能有效反映控制理论中的许多关键问题,如非线性问题、鲁棒性问题、随动问题、镇定、跟踪问题等。

因此倒立摆系统作为控制理论教学与科研中典型的物理模型,常被用来检验新的控制理论和算法的正确性及其在实际应用中的有效性。

从 20 世纪 60 年代开始,各国的专家学者对倒立摆系统进行了不懈的研究和探索。

倒立摆系统按摆杆数量的不同,可分为一级,二级,三级倒立摆等,多级摆的摆杆之间属于自由连接(即无电动机或其他驱动设备)。

由中国的大连理工大学李洪兴教授领导的“模糊系统与模糊信息研究中心”暨复杂系统智能控制实验室采用变论域自适应模糊控制成功地实现了四级倒立摆。

因此,中国是世界上第一个成功完成四级倒立摆实验的国家。

倒立摆的控制问题就是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡和过大的角度和速度。

当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。

2.倒立摆模型分析倒立摆系统的输入为小车的位移(即位置)和摆杆的倾斜角度期望值,计算机在每一个采样周期中采集来自传感器的小车与摆杆的实际位置信号,与期望值进行比较后,通过控制算法得到控制量,再经数模转换驱动直流电机实现倒立摆的实时控制。

直流电机通过皮带带动小车在固定的轨道上运动,摆杆的一端安装在小车上,能以此点为轴心使摆杆能在垂直的平面上自由地摆动。

作用力F平行于铁轨的方向作用于小车,使杆绕小车上的轴在竖直平面内旋转,小车沿着水平铁轨运动。

当没有作用力时,摆杆处于垂直的稳定的平衡位置(竖直向下)。

为了使杆子摆动或者达到竖直向上的稳定,需要给小车一个控制力,使其在轨道上被往前或朝后拉动。

我们的分析对象是一阶倒立摆。

很多国内实验都说可以合理的假设空气阻力为0,但查阅了更多的文献和真正仿真做出模型并在网络上开源的一些实验后,我认为这是不正确的。

  1. 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
  2. 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
  3. 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。

实用文档研究生课程实验报告课程名称:线性系统实验名称:平面二级倒立摆实验班级: 12S0441学号:12S104057姓名:白俊林实验时间: 2012 年12 月 21 日控制科学与工程教学实验中心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 q T q q V q q =-(1)i d L Lf dt q qδδδδ-= (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 T m 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 VMx 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())163(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作用在系统上的外力由以上方程,将以下参数代入123121.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)根据建模结果仔细计算并寻找合适的理论控制器参数。

相关文档
最新文档