三级倒立摆建模与控制器设计仿真
倒立摆控制器设计与仿真
摘要倒立摆系统是一个非线性自然不稳定系统, 是进行控制理论教学及开展各种控制实验的理想实验平台。
许多抽象的控制概念如控制系统的稳定性、可控性、系统收敛速度和系统抗干扰能力等，都可以通过倒立摆系统直观的表现出来。
除教学用途外，倒立摆系统的高阶次、不稳定、多变量、非线性和强耦合等特性使得许多现代控制理论的研究人员一直将它视为研究对象。
本课题以固高倒立摆系统为研究对象，通过Simulink搭建非线性模型然后将其线性化，并与数学方法近似的线性模型进行了比较。
采用根轨迹法设计出确定参数下的使系统稳定的控制器，并将其应用于倒立摆实际控制中，在摆杆角度控制器方面获得了很好的的控制效果。
最后，在MATLAB/Simulink环境下分别观察了线性模型和非线性模型的仿真情况。
本文以直线一级倒立摆系统为核心，掌握了在倒立摆系统控制方面国内外的研究情况。
通过实现对倒立摆的稳定控制，进而掌握了控制系统设计的一些基本方法。
一、绪论（一）课题研究的背景及意义倒立摆的最初研究始于上世纪50年代，由美国麻省理工学院（MIT）的控制论专家根据火箭发射助推器的原理设计而来，随着研究的深入和实际问题的推动而不断发展至今，已发展出了三级摆和四级摆。
这些研究成果具有重要的工程前景，在控制等领域中发挥了巨大的作用。
作为研究控制理论的一种非常典型的实验装置，倒立摆系统具有形象直观、结构简单、成本低廉、构件组成参数和形状易于改变的特点。
倒立摆是多种技术、多个领域的有机结合，包括机器人技术、控制理论技术、计算机控制技术等。
很多抽象的控制概念，如控制系统的稳定性、系统的可控性、系统收敛速度和抗干扰能力等，都可通过倒立摆系统直观形象的表现出来。
倒立摆控制系统本身又是一个多变量、高阶次、强耦合的非线性自然不稳定系统系统，在自动控制领域中，倒立摆仿真或者实物控制实验，已成为检验一种新的控制理论是否有效的试金石，同时也是产生一种新的控制方法所必须依据的基础实验平台。
自动化实验倒立摆实验附仿真结果图
一、直线一级倒立摆的仿真(一)直线一级倒立摆的数学建模对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难。
但是忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。
下面我们采用其中的牛顿－欧拉方法和拉格朗日方法分别建立直线型一级倒立摆系统的数学模型。
图2 直线一级倒立摆模型φ摆杆与垂直向上方向的夹角；θ摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）。
图3 小车及摆杆受力分析分析小车水平方向所受的合力，可以得到以下方程：由摆杆水平方向的受力进行分析可以得到下面等式：把这个等式代入式1中，就得到系统的第一个运动方程：为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面方程：力矩平衡方程如下：注意：此方程中力矩的方向，由于θ=π+φ,cosφ= −cosθ,sinφ= −sin θ，故等式前面有负号。
合并这两个方程，约去P 和N，得到第二个运动方程：设θ=π+φ（φ是摆杆与垂直向上方向之间的夹角），假设φ与1（单位是弧度）相比很小，即φ<<1，则可以进行近似处理：。
用u 来代表被控对象的输入力F，线性化后两个运动方程如下：对式9进行拉普拉斯变换，得到注意：推导传递函数时假设初始条件为0。
由于输出为角度φ，求解方程组的第一个方程，可以得到：或如果令v = x，则有：把上式代入方程组的第二个方程，得到：整理后得到传递函数：其中设系统状态空间方程为：方程组对解代数方程，得到解如下：整理后得到系统状态空间方程：设则有：实际系统的模型参数如下:M 小车质量1.096 Kgm 摆杆质量0.109 Kgb 小车摩擦系数0 .1N/m/secl 摆杆转动轴心到杆质心的长度0.2 5mI 摆杆惯量0.0034 kg*m*m把上述参数代入，可以得到系统的实际模型。
摆杆角度和小车位移的传递函数：摆杆角度和小车加速度之间的传递函数为：摆杆角度和小车所受外界作用力的传递函数：以外界作用力作为输入的系统状态方程：(二)倒立摆的PID调节：经典控制理论的研究对象主要是单输入单输出的系统，控制器设计时一般需要有关被控对象的较精确模型。
三级倒立摆建模、控制器设计
三级倒立摆线性系统理论作业：以三级倒立摆为研究对象，建立对象模型，设计状态观测器，设计控制器（要有仿真结果）。
一倒立摆1概述倒立摆的控制是控制理论应用的一个典型范例,一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的,倒立摆系统就其本身而言是一个高阶次、不稳定、多变量、非线性、强耦合系统。
将这样一个复杂系统作为被控对象,在控制过程中能有效地反映出控制中的许多关键问题, 如非线性问题、鲁棒性问题、随动问题、镇定问题、跟踪问题、解耦问题以及不稳定问题等。
2分类倒立摆系统按摆杆数量的不同，可分为一级，二级，三级倒立摆等，多级摆的摆杆之间属于自由连接（即无电动机或其他驱动设备）。
现在由中国的北京师范大学李洪兴教授领导的“模糊系统与模糊信息研究中心”暨复杂系统智能控制实验室采用变论域自适应模糊控制成功地实现了四级倒立摆。
是世界上第一个成功完成四级倒立摆实验的国家。
3倒立摆的控制目标摆的控制问题就是使摆杆尽快地达到一个平衡位置，并且使之没有大的振荡和过大的角度和速度。
当摆杆到达期望的位置后，系统能克服随机扰动而保持稳定的位置。
4倒立摆的控制方法倒立摆系统的输入为小车的位移（即位置）和摆杆的倾斜角度期望值，计算机在每一个采样周期中采集来自传感器的小车与摆杆的实际位置信号，与期望值进行比较后，通过控制算法得到控制量，再经数模转换驱动直流电机实现倒立摆的实时控制。
直流电机通过皮带带动小车在固定的轨道上运动，摆杆的一端安装在小车上，能以此点为轴心使摆杆能在垂直的平面上自由地摆动。
作用力u平行于铁轨的方向作用于小车，使杆绕小车上的轴在竖直平面内旋转，小车沿着水平铁轨运动。
当没有作用力时，摆杆处于垂直的稳定的平衡位置（竖直向下）。
为了使杆子摆动或者达到竖直向上的稳定，需要给小车一个控制力，使其在轨道上被往前或朝后拉动。
二．三级倒立摆系统的数学模型1.系统的结构三级倒立摆系统主要由控制对象, 导轨, 电机,皮带轮, 传动带以及电气测量装置组成,控制对象由小车,下摆, 中摆,上摆组成,上、中、下摆由轴承连接,并且可以在平行导轨的铅垂平面内自由转动,三个电位器分别安装在连接处 ,测量摆的相对偏角11223--θθθθθ，，其原理结构图如图 1 所示,系统运动分析示意图 如图 2 所示2.系统的数学模型 2.1假设条件(1)、上、中 、下摆及小车都是刚体;(2)、皮带轮与传动带之间无相对滑动,传动带无伸长现象; (3)、小车的驱动力与直流放大器的输入成正比,且无滞后, 忽略电机电枢绕组中的电感;(4)、小车运动时所受的摩擦力正比于小车的速度 ; (5)、各摆的摩擦力矩与相对速度(角速度)成正比 2.2系统参数说明m0 —小车系统的等效质量 1.32822kg ; m1 —下摆质量 0 .22kg ; m2—中摆质量 0 .22kg ;m3—上摆质量 0 .187kg ;J1—下摆质心至转轴处转动惯量 0.004963kg .m ; d1—下摆质心至转轴之间的距离 0 .304m ; J2—中摆质心至转轴处转动惯量 0.004963 kg .m ; d2—中摆质心至转轴之间的距离 0 .304m ; J3—上摆质心至转轴处转动惯量 0.004824 kg .m ; d3—上摆质心至转轴之间的距离 0 .226m ; d4 —中、下摆转轴间的距离 0.49m ; d5 —上、中摆转轴间的距离 0.49m ; d6—上摆杆长度;f0—小车系统的摩擦系数 22.9147 kg/s;f1—下摆转轴处的摩擦阻力矩系数 0.007056kg .m/s; k0—电机的机电常数 0.9467N;f2—中摆转轴处的摩擦阻力矩系数 0.002646 kg .m/s; k1—功放的电压增益 8.0;f3 —上摆转轴处的摩擦阻力矩系数 0.002646 kg .m/s; R0 —电机的电枢绕组内阻 8.55Ω; R1—功放输出电阻 1 .252Ω; d —皮带轮直径 0.13m ; g —重力加速度。
倒立摆系统的控制器设计1（含5篇）
倒立摆系统的控制器设计1（含5篇）第一篇：倒立摆系统的控制器设计1刘翰林倒立摆系统的控制器设计引言1.1 问题的提出生活在大千世界里，摆无处不在。
何为摆？支点在下，重心在上，恒不稳定的系统或装置的叫倒立摆。
相反，支点在上而重心在下的则称为顺摆。
现实生活中，旋转着的芭蕾舞演员，杂技的顶伞，墙上挂钟的钟摆，工作中的吊车等都可被看作是一个摆。
倒立摆的种类繁多，其中包括悬挂式、直线、环形、平面倒立摆等。
一级、二级、三级、四级乃至多级倒立摆。
1.2 倒立摆系统简介倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合，其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统，可以作为一个典型的控制对象对其进行研究。
最初研究开始于二十世纪50年代，麻省理工学院（MIT）的控制论专家根据火箭发射助推器原理设计出一级立摆实验设备。
近年来，新的控制方法不断出现，人们试图通过倒立摆这样一个典型的控制对象，检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力，从而从中找出最优秀的控制方法。
倒立摆系统作为控制理论究中的一种比较理想的实验手段，为自动控制理论的教学、实验和科研构建一个良好的实验平台，以用来检验某种控制理论或方法的典型方案，促进了控制系统新理论、新思想的发展。
由于控制理论的广泛应用，由此系统研究产生的方法和技术将在半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截控制系统、航空对接控制技术、火箭发射中的垂直度控制、卫星飞行中的姿态控和一般工业应用等方面具有广阔的利用开发前景。
平面倒立摆可以比较真实的模拟火箭的飞行控制和步行机器人的稳定控制等方面的研究。
1.3 倒立摆的分类倒立摆已经由原来的直线一级倒立摆扩展出很多种类，典型的有直线倒立摆，环形倒立摆，平面倒立摆和复合倒立摆等，倒立摆系统是在运动模块上装有倒立摆装置，由于在相同的运动模块上可以装载不同的倒立摆装置，倒立摆的种类由此而丰富很多，按倒立摆的结构来分，有以下类型的倒立摆： 1)直线倒立摆系列直线倒立摆是在直线运动模块上装有摆体组件，直线运动模块有一个自由度，小车可以沿导轨水平运动，在小车上装载不同的摆体组件，可以组成很多类别的倒立摆，直线柔性倒立摆和一般直线倒立摆的不同之处在于，柔性倒立摆有两个可以沿导轨滑动的小车，并且在主动小车和从动小车之间增加了一个弹簧，作为柔性关节。
模糊控制在倒立摆中的MATLAB仿真应用
TAIYUAN UNIVERSITY OF SCIENCE & TECHNOLOGY题目：院（系）：专业：学生姓名：学号：模糊控制在倒立摆中的仿真应用1、倒立摆系统简介倒立摆有许多类型,例如图1-1的a和b所示的分别是轮轨式一级倒立摆系统和二级倒立摆系统的模型。
倒立摆是一个典型的快速、多变量、非线性、本质不稳定系统,它对倒置系统的研究在理论上和方法论上具有深远的意义。
对倒立摆的研究可归结为对非线性多变量本质不稳定系统的研究,其控制方法和思路在处理一般工业过程中也有广泛的用途。
近些年来国内外不少专家学者对一级、二级、三级、甚至四级等倒立摆进行了大量的研究,人们试图寻找不同的控制方法实现对倒立摆的控制,以便检查或说明该方法的严重非线性和本质不稳定系统的控制能力。
2002年8月11日,我国的李洪兴教授在国际上首次成功实现了四级倒立摆实物控制,也标志着我国学者采用自己提出的控制理论完成的一项具有原创性的世界领先水平的重大科研成果。
图1-1 倒立摆模型(a)一级倒立摆模型（b）二级倒立摆模型倒立摆系统可以简单地描述为小车自由地在限定的轨道上左右移动。
小车上的倒立摆一端用铰链安装在小车顶部,另一端可以在小车轨道所在的垂直平面内自由转动,通过电机和皮带传动使小车运动,让倒立摆保持平衡并保持小车不和轨道两端相撞。
在此基础上在摆杆的另一端铰链其它摆杆,可以组成二级、三级倒立摆系统。
该系统是一个多用途的综合性试验装置,它和火箭的飞行及步行机器人的关节运动有许多相似之处,其原理可以用于控制火箭稳定发射、机器人控制等诸多领域。
倒立摆系统控制原理单级倒立摆系统的硬件包括下面几个部分：计算机、运动控制卡、伺服系统、倒立摆和测量元件，由它们组成的一个闭环系统，如图1-2所示，就是单级倒立摆系统的硬件结构图。
图1-2 单级倒立摆硬件结构图通过角度传感器可以测量摆杆的角度，通过位移传感器可以得到小车的位置，然后反馈给运动控制卡，运动控制卡与计算机双向通信。
倒立摆滑模变结构控制器的设计与实现
求解微 分 方程 （ 以ｓ ＞ ０为例 ） 可得
ｓ 一
｝ ） ｅ 詈
０ 从堕式可 看｛ 出 。 趋近运动以ｓ ＝一 ８ ／ ｋ 为渐近线， 趋近速度与 ｋ 正相关。因此， 参数 ｋ 和 即决定 趋遗逮瘦： ， 受 决楚 系统能否有效抑制抖振。为此本文针对上述倒立摆模型， 通过仿真研究了参数 ｋ 同值好 档控制范围、 最大偏移量、 调节时间几个方面性能指标， 综合考虑， 最终确定 酶参数值 珀， ： ８ ， 由 倒立摆的 践性映撼旁 及趋逦这动的表达式得 ； ＝ ｃ； ＝ Ｃ （ Ａ ｘ ＋ Ｂ ｕ ） ＝一 ｓ ｇ ｎ ｓ — ｋ ｓ 。从而可得趋
Ｆ ｉ ｇ ． １ Ｓ ｉ ｍｕ ｌ ａ ｔ ｉ ｏ ｎ ｒ ｅ ｓ ｕ ｌ ｔ ｓ ｏ ｆ ｓ ｌ ｉ ｄ ｅ ｍｏ ｄ ｅ ｖ ａ ｒ ｉ ａ ｂ ｌ ｅ ｓ ｔ ｒ ｕ ｃ ｔ ｕ ｒ ｅ ｃ ｏ ｎ ｔ ｒ ｏ ｌ
图 ２ 倒立摆实时控制结果
Ｆ ｉ ｇ ． ２ Ｐ ｈ ｏ ｔ ｏ ｏ ｆ ｒ ｅ ａ ｌ —ｔ ｉ ｍｅ ｃ ｏ ｎ ｔ ｒ ｏ ｌ ｆ ｏ ｒ ｉ ｎ ｖ ｅ ｒ ｔ ｅ ｄ ｐ ｅ ｎ ｄ ｕ ｌ ｕ ｍ
母
旬． ０１
Ｆ ０ ． ０ ５
… ÷ ． ． … ． ． … ． ． 。 鎏 霎 ５ ｙ ｆ ： － ： ： － ． ： … ： ： ： … ： ： ： ： ：
． ． ． ．
侧
援
。
吃
司 ０ ８ Ｄ
图１ 滑模变结构控制仿真 曲线
’
０ １ ＝Ｃ ２ Ｋ
ｅ＝［ ｅ 。 ０ ］ ＝［ ｅ Ｋ ０ ］＝０ ［ Ｋ ， ］ （ 常取 ｅ ＝ ， ） 所 以最终 可确定 滑模 面的方 程为 ： ｓ ＝Ｃ ｘ：Ｃ Ｔ ｘ 根据 系统参 数及 倒立摆 的性 能要求 ， 配置 极点 为 ： ［一１ ＋ ． 『 一１ 一 一９ ］ ， 由此 可得滑模 面方 程为 ： ｓ ＝ ＝［ １ ． ８ ３ ６ ７ １ １ ． ７ ７ ９ ３ ２ ． ０ ４ ０ ８ １ ． ８ ６ ５ ９ ］
三级倒立摆建模与控制器设计仿真
>> figure(2);plot(T,Y(:,2));
>> xlabel('Time/sec');ylabel('01/rad');title('下摆角度变化曲线');grid;
>> figure(3);plot(T,Y(:,3));
MATLAB中，用函数eig（A）来计算系统矩阵的特征值，经过计算，式⑵式所示的线性定常系统的特征值为：
r1 =[013.27158.39193.1656-18.2950-2.9940-8.5547-13.7810]
因此，该系统为不稳定系统，需加外部控制器形如式（2）所示的线性定常系统能控的充分必要条件是：
PA+ P-PB +Q=0⑷
可以得到状态反馈阵
此时各摆角的动态和稳态指标较为理想。初始条件为 。
仿真结果
程序：
>>A=[0,0,0,0,1,0,0,0;0,0,0,0,0,1,0,0;0,0,0,0,0,0,1,0;0,0,0,0,0,0,0,1;0,-3.6551,0.12698,0.44281,-16.809,0.016897,-0.0056447,-0.0032595;0,45.74,-80.216,-8.3647,57.098,-0.56272,0.32956,-0.072179;0,-49.782,169.9,-4.781,-62.143,0.98145,-0.65964,0.32957;0,-5.159,-114.49,72.269,6.4401,-0.53453,0.51673,-0.76437;];
三种趋近律下的倒立摆滑模控制器设计与实现
第 ３ ２卷 第 １ ０期
韶关 学 院学报 ・自然 科学
Ｊ ｕ ａ ｆＳ ａ ｇ ａ ｉｅ ｓｔ ・Ｎａｕ ａ ｃｅ ｃ ｏ ｒ ｌｏ ｈ ｏ ｕ ｎ Ｕｎｖ ｒｉ ｎ ｙ ｔｒｌＳ ｉｎ ｅ
０ ｔ ０ ｃ． １ ２ １ Ｖｏ ．２ １ ３ Ｎ ．０ ｏ１
这两个 状态 变量 的变 化趋势 采用 了状 态空 间数 学模 型 ：＝ ｘ Ｂ ， ｘ Ａ ＋ ｕ 其 中 ∈ Ａ∈Ｒ ｘ Ｂ∈尺 Ｒ， ＂Ｒ ， 尺 ． （） １
在设 计 滑动 模态 控 制器 时 ， 使 系统能 够 在任 意 的初 始状 态 下 ， 渐 近稳 定 于原 点 ， 且要 求控 制 对 要 都 并 干扰有 鲁棒 性 ． 在 控制 器 的设 计 过程 中首先 要设 计切换 面 ： ） ． ＝ ＝ 其 中 ＣＥＲ ｘ Ｒ． 系统沿 切 换 面 ｓ ＝ ）０上 的运 动 ， 到达理想 终 点 时 ， 足 ｓ ０和ｓ ０ 而 实 际上 系统运 动 点沿 切换 面上下 满 ＝ ＝， 穿行 ． 滑模 运动 由两 部分 组 成 即趋 近运 动和 滑模 运 动． 近运 动是 系统 从 任意初 始 状态 趋 向切 换面 ， 趋 直到 到 （） ２
达切 换 面的运 动 ． 于趋 近运 动 的具 体 轨迹不 作 任何 限制 ， 对 因此 采用 趋 近律 的方法 可 以改 善趋 近运 动 的动
收 稿 日期 ：０ １ ｏ 一 １ ２ １ 一 ７ Ｉ
作者简介： 刘文秀（９ Ｏ ）女 ， １８ －， 内蒙古通辽人 ， 韶关学院物理与机电工程学院讲师 ， 硕士 ， 主要从事自动化方面的教学和研究
ＭＡ Ｌ Ｂ仿 真 ， ＴＡ 从仿 真结果可 以看 出饱 和函数做为趋 近律 时设计方法
直线倒立摆系统的LQR控制器设计及仿真_毕业设计精品
直线倒立摆系统的LQR控制器设计及仿真_毕业设计精品1.引言直线倒立摆系统主要由一个质量块和一个固定的轨道组成，质量块可以在轨道上自由运动。
该系统的目标是在面对各种扰动时保持质量块的平衡。
LQR控制器是一种优化控制方法，可以通过调整控制器的参数来实现系统动态响应的优化。
2.直线倒立摆系统建模m*x''+b*v+m*g=f-u在LQR控制器设计过程中，需要将系统的动力学方程转化为状态空间模型。
定义状态变量为x1=x，x2=x'，那么系统的状态空间模型可以表示为：x1'=x2x2'=(1/m)*(f-u-b*x2-m*g)3.LQR控制器设计LQR控制器设计的目标是通过调整控制器的参数来最小化系统的性能指标J。
在直线倒立摆系统中，我们可以选择以能耗作为性能指标，即J = ∫(u(t)^2)dt。
那么LQR控制器设计的目标是最小化能耗。
LQR控制器设计方法的关键是设计系统的状态反馈增益矩阵K。
具体的设计步骤如下：1)将系统的状态空间模型表示为矩阵形式：x'=Ax+Buy=Cx+Du其中，A为状态转移矩阵，B为输入矩阵，C是输出矩阵，D为直接递增矩阵。
2) 根据系统的状态空间模型计算系统的LQR控制器增益矩阵K。
增益矩阵K可以通过解代数矩阵Riccati方程得到：K=(R+B'*S*B)^(-1)*B'*S*A其中，S为Riccati方程的解。
3) 计算系统的控制器增益矩阵L。
增益矩阵L可以通过解代数矩阵Riccati方程得到：L=(R+B'*S*B)^(-1)*B'*S*C4.LQR控制器仿真在设计完成LQR控制器之后，可以进行仿真实验来验证控制器的效果。
可以使用MATLAB或Simulink来进行仿真。
在仿真实验中，需要设置各个参数的初始值，并且加入一些扰动以测试控制器的稳定性。
通过观察系统的状态变量和控制力的响应曲线，可以评估控制器的性能。
倒立摆系统的控制算法及仿真
倒立摆系统的控制算法及仿真1．1 倒立摆控制算法1．1．1 倒立摆控制算法概述单级倒立摆的稳定控制，实际上是一单输入多输出系统的稳定控制。
此时系统输入是电机控制电压u，输出是倒立摆竖直方向角度θ和旋臂位置ϕ。
对方程(2.5)进行变形即得θ与u 之间的输入输出方程,很明显,它是一个不稳定的二阶系统。
控制倒立摆使之稳定的方法很多,当前已有的倒立摆控制规律可总结为:(1)PID控制,通过对倒立摆物理模型的分析，建立倒立摆的动力学模型,然后使用状态空间理论推导出其非线性模型，再在平衡点处进行线性化得到倒立摆系统的状态方程和输出方程，于是就可设计出PID控制器实现其控制；(2)状态反馈H∞控制，通过对倒立摆物理模型的分析,建立倒立摆的动力学模型,然后使用状态空间理论推导出状态方程和输出方程，于是就可应用H∞状态反馈和Kalman 滤波相结合的方法,实现对倒立摆的控制；(3)利用云模型实现对倒立摆的控制，用云模型构成语言值,用语言值构成规则,形成一种定性的推理机制。
这种拟人控制不要求给出被控对象精确的数学模型，仅仅依据人的经验、感受和逻辑判断，将人用自然语言表达的控制经验,通过语言原子和云模型转换到语言控制规则器中，就能解决非线性问题和不确定性问题；(4)神经网络控制，业已证明神经网络(NeuralNetwork ,NN) 能够任意充分地逼近复杂的非线性关系，NN 能够学习与适应严重不确定性系统的动态特性，所有定量或定性的信息都等势分布贮存于网络内的各种神经元，故有很强的鲁棒性和容错性，也可将Q学习算法和BP神经网络有效结合，实现状态未离散化的倒立摆的无模型学习控制；(5)遗传算法( Genetic Algorithms , GA)，高晓智在Michine 的倒立摆控制Boxes 方案的基础上，利用GA 对每个BOX 中的控制作用进行了寻优，结果表明GA可以有效地解决倒立摆的平衡问题；(6)自适应控制，主要是为倒立摆设计出自适应控制器；(7)模糊控制，主要是确定模糊规则，设计出模糊控制器实现对倒立摆的控制；(8)使用几种智能控制算法相结合实现倒立摆的控制，比如模糊自适应控制，分散鲁棒自适应控制等等，(9)采用GA 与NN 相结合的算法，首先建立倒立摆系统的数学模型，然后为其设计出神经网络控制器，再利用改进的贵传算法训练神经网络的权值，从而实现对倒立摆的控制，采用GA 学习的NN 控制器兼有NN 的广泛映射能力和GA 快速收敛以及增强式学习等性能。
基于倒立摆顺摆控制的建模与仿真研究
基于倒立摆顺摆控制的建模与仿真研究基于倒立摆顺摆控制的建模与仿真研究倒立摆是一种经典的非线性控制系统，其稳定性分析和控制方法一直是控制理论研究的热点。
本文将介绍基于倒立摆顺摆控制的建模与仿真研究。
一、倒立摆系统建模倒立摆系统由一个质量为m、长度为l的杆和一个质量为M的小车组成，杆与小车通过一根无摩擦的轴连接。
小车可以在水平方向上移动，杆可以在竖直方向上旋转。
系统的状态变量为小车的位置x、小车的速度v、杆的角度θ和杆的角速度ω。
根据牛顿第二定律和杆的运动方程，可以得到系统的动力学方程：m x'' = F - m g sinθ - m l θ'^2M x'' = F + m l θ'' cosθ - m l θ'^2 sinθl θ'' + g sinθ = x'' cosθ其中，F为小车受到的外力，g为重力加速度。
二、顺摆控制顺摆控制是一种基于状态反馈的控制方法，其目的是使倒立摆系统保持在竖直方向上。
顺摆控制器的设计需要满足系统的稳定性和性能要求。
首先，需要将系统的动力学方程转化为状态空间形式：x' = Ax + Buy = Cx其中，x为状态向量，u为控制输入，y为输出向量，A、B和C为系统的矩阵。
然后，可以设计状态反馈控制器：u = -Kx其中，K为状态反馈矩阵。
最后，可以通过极点配置法或线性二次调节法来确定状态反馈矩阵K，以满足系统的稳定性和性能要求。
三、仿真研究为了验证顺摆控制器的有效性，可以进行仿真研究。
使用MATLAB/Simulink软件，可以建立倒立摆系统的仿真模型，并进行控制器的设计和仿真。
首先，需要建立倒立摆系统的仿真模型。
可以使用Simulink中的Simscape Multibody工具箱，将倒立摆系统建模为一个多体动力学系统。
然后，可以添加控制器模块，设计顺摆控制器，并将其与倒立摆系统相连。
倒立摆的s函数建模及仿真
倒立摆的s函数建模及仿真倒立摆是一类普遍存在于现实生活中的控制工程问题，也是机器人控制领域中的典型问题。
为了探究倒立摆的控制方法，需要进行建模和仿真研究。
本文将介绍如何对倒立摆进行s函数建模，并进行仿真研究。
一、倒立摆的建模1. 系统假设倒立摆系统假设为：（1）摆杆质量可以忽略，只考虑质点的重量；（2）摆杆的摩擦系数可以忽略；（3）摆杆的惯性可以忽略。
2. 系统模型假设摆杆长度为L，质点质量为m，摆杆与竖直方向成θ角度，摩擦系数为f，则可得到如下系统模型：mx”=mgLsinθ-fx’+uθ’=x其中，x表示质点距离垂直方向的距离，u是外部输入信号，可用来控制系统。
3. s函数模型根据系统模型，可以进行s函数建模。
将其转化为状态空间的形式，得到如下s函数模型：function [sys,x0,str,ts] = pendulum(t,x,u,flag)switch flag% Initializationcase 0sys = [0 0 1 2 0 1];x0 = [0; 0];str = [];ts = [];% Derivativescase 1sys = [x(2); (u(1)*cos(x(1))-9.8*sin(x(1)))/0.5];% Outputscase 3sys = [x(1)];% Unhandled flagscase {2, 4, 9}sys = [];otherwiseerror(['Unhandled flag = ',num2str(flag)]);end二、倒立摆的仿真倒立摆的仿真可以使用Matlab软件进行实现。
下面介绍具体的仿真过程：1. 创建仿真模型打开Matlab软件，选择“Simulink”工具栏，创建一个新的模型文件。
2. 添加控制器在模型中添加一个控制器，用于产生外部输入信号u。
具体可选择Proportional Integral Derivative(PI D)控制器或者其他控制器。
倒立摆系统建模及MATLAB仿真
倒立摆系统的建模及MATLAB仿真通过建立倒立摆系统的数学模型,应用状态反馈控制配置系统极点设计倒立摆系统的控制器,实现其状态反馈,从而使倒立摆系统稳定工作。
之后通过MA TLAB 软件中Simulink工具对倒立摆的运动进行计算机仿真,仿真结果表明,所设计方法可使系统稳定工作并具有良好的动静态性能。
倒立摆系统是1个经典的快速、多变量、非线性、绝对不稳定系统,是用来检验某种控制理论或方法的典型方案。
倒立摆控制理论产生的方法和技术在半导体及精密仪器加工、机器人技术、导弹拦截控制系统和航空器对接控制技术等方面具有广阔的开发利用前景。
因此研究倒立摆系统具有重要的实践意义,一直受到国内外学者的广泛关注。
本文就一级倒立摆系统进行分析和研究,建立倒立摆系统的数学模型,采用状态反馈极点配置的方法设计控制器,并应用MA TLAB 软件进行仿真。
1 一级倒立摆系统的建模1. 1 系统的物理模型如图1 所示,在惯性参考系下,设小车的质量为M ,摆杆的质量为m ,摆杆长度为l ,在某一瞬间时刻摆角(即摆杆与竖直线的夹角)为θ,作用在小车上的水平控制力为f 。
这样,整个倒立摆系统就受到重力,水平控制力和摩擦力的3 外力的共同作用。
图1 一级倒立摆物理模型1. 2 系统的数学模型在系统数学模型中,本文首先假设:(1) 摆杆为刚体。
(2)忽略摆杆与支点之间的摩擦。
(3)忽略小车与导轨之间的摩擦。
然后根据牛顿第二运动定律,求得系统的运动方程为:方程(1) , (2) 是非线性方程,由于控制的目的是保持倒立摆直立,在施加合适的外力条件下,假定θ很小,接近于零是合理的。
则sinθ≈θ,co sθ≈1 。
在以上假设条件下,对方程线性化处理后,得倒立摆系统的数学模型:1. 3 系统的状态方程以摆角θ,角速度θ',小车的位移x ,速度x'为状态变量,输出为y 。
即令:则一级倒立摆系统的状态方程为:2 控制器设计及MATLAB 仿真2. 1 极点配置状态反馈的基本原理图2 状态反馈闭环控制系统极点配置的方法就是通过一个适当的状态反馈增益矩阵的状态反馈方法,将闭环系统的极点配置到任意期望的位置。
三级倒立摆系统基于滑模的鲁棒控制
收 稿 日期 ： ０ １ １ － ４ ２ ０ —０２ ．
座 上 并通 过 其 转 轴 联 接 下 摆 与 底 座 ， 得 下摆 相 对 使 于 底座 只能 进 行 转 动 ； 另一 个 驱 动 电机 则 安 装 在 上
究 ， ｕ ｕａ等 对 一 个 具 有 两个 驱 动 电机 的三 级倒 Ｆ ｒｔ
立 摆 系统 进 行 了控 制 研 究 ， 中 一个 电 机 固定 于底 其
现 象 ， 感 器 具 有 标 定 误 差 现 象 以及 系 统 中某 些 物 传 理 变 量 带有 的 约束 条件 等． 此 对 倒 立摆 系 统 进 行 因
式 中： “为 驱 动 电 机输 入 电压 ； Ｋ 为 从 模 拟 电 压 输 出 到小 车 受 力 的增 益 ， Ｖ； 为 库 仑 摩 擦 力 ． 式 Ｎ／ Ｅ 上 中的 动能 丁、 势能 及耗 能 Ｄ 如式 （ ） （ ） ２ ～ ４ 表示 ，
提 出 了一 种带 降 阶 动态 观 测器 的 Ｈ 控 制 方法 ．
通 过 对 一 级 和 二 级 倒 立 摆 的 研 究 发 现 ， 用 一 利
图 １ 三 级 倒 立 摆 系统 示 意 图
Ｆｉ Ｔｒｐｌ ｎｖｅ ｔ ｄ ｐｅ ｇ．１ ｉ ｅｉ ｒ ｅ ｎｄｕｌ ｙ ｔ ｍ ｕｍ ｓ ｓ ｅ
ａ ｒｐｌ ｉ ｖｅ ｔ ｄ ｅｎ ｌ ｍ ｓ ｔ ｍ ｗ ｉｈ ｉ ｇｌ ｉ ｕｔ Ｔ ｈｅ ｍ ｐｌ ｙ ｅ ｏｆ ｕｃ ａ ｔ ｃ ｉ ｅ ｐｐ ａ ｓ ｔ ｉ ｅ ｎ ｒ ｅ ｐ ｄｕ ｕ ｙｓ ｅ ｔ ｓ ｎ ｅ ｎｐ ． ｅ ｏ ｍ ｎｔ ｓ ｈ ｅ ｈｎ ｑｕ ａ ｅ ｒ
个 线性 的 控 制器 很 难 得 到很 好 的控 制 效 果 ． 三 级 而 倒 立摆 系 统 除 了本 身结 构 要 比一 级 和二 级 倒 立摆 系 统 复杂 外 ， 于 干扰 力 矩 、 节摩 擦 力及 测 量 噪声 等 对 关 极 其敏 感 ． 文 针对 三 级倒 立 摆 系统 的 特 点 ， 本 利用 一 种 基 于 滑 模 的 鲁 棒 控 制 方 法进 行仿 真 研究 ． 滑 模 在 控 制 中 当系 统 在滑 模 面上 运 行 时对 于外 界 干 扰具 有 很 强 的鲁 棒性 ， 在 稳 态 时存 在 颤振 现 象 ； 但 而倒 立 摆 系统 为 了保 持摆 的垂 直 倒 立 ， 即使 达 到 稳 态后 ， 摆 各 也 是 通 过 不 停 的 移 动来 保 持 平 衡 ． 此 本 文 的控 制 因 方 法 正 是 利 用 这 一 特 点 ． 先 对 三 级 倒 立 摆 系 统 附 首 加 一 个 虚 拟状 态 构成 一 个 新 的 系统 ， 后 设 计 滑 模 然 面 使 得 该 系 统运 行 到 滑模 面 上 时 ， 倒 立 摆 系统 的 原 动 态 性 能 得 到 满 足 ； 外 适 当地 选 取 虚 拟 状 态 初 始 此
利用ADAMS与MATLAB对平面三级倒立摆的仿真
ＫＯＮＧ ｎ ｕｏ，ＸＩ Ｆａ ｇ ＡＮＧ ｉ ＺＨＯＮＧ ｉ ｇ ｈｉ Ｆｅ ， Ｔｎ ｚ
（ ｕ ｉ ｎｖｒｔ Ｇ ａｇ ｏｇＪａｇ ｅ ２ ０ ０ Ｃ ｉａ Ｗ ｙ Ｕ ｉ ｓｙ， ｕ ｎｄ ｎ ｉｎ ｍ ｎ５ ９ ２ ， ｈｎ ） ｅｉ
Ａｂ ｔ ａ ｔ Ｂｕｉ ｎ ＡＤＡＭＳ ｐ ａ ｒｔｉ ｅ ｉ ｖ ｒｅ ｅ ｄ ｌ ｍ ｉｔ ａ ｒ ｔｔｐｉ ｄ ｌ ｎ ｓ ｓ ｔ ｅ ｓ ｒ ｃ ： ｌ ｉ ｔ ｌｎａ ｒｐｌ ｎ ｅｔ ｄ ｐ ｎ ｕ ｕ ｖｒｕ ｌｐ ｏ ｏｙ ｎｇ ｍｏ ｅ ，ａ ｄ ｕ ｅ ｈ
Ｉ ｄ ｉｏ ， Ｄ ＭＳａ ｄＭＡ Ｌ Ｂｊｉｔ ｙｔｍ ｃ ｎｒ ｉ ｌ ｉ ， ａ ｆ ｃ ｔｅｅ ｅｔ ｆ ｅｌｉ ｅｃｎ ｎａ ｄｔ ｎ Ａ Ａ ｎ Ｔ Ａ ｎ ｓｓ ｏ ｔ ｌ ｍｕａ ｏ ｃｎｒｌ ｔｈ ｆ ｃ ｏ ａ—ｍ ｏ — ｉ ｏ ｅ ｏｓ ｔｎ ｅｅ ｆ ｒ ｔ
ｔｏ ｌｏ ｉｈ ，ｗｉ ｒ ａ ｒ ｍｏｉ ｎ ｖ ｌ ｅ ｒ ｌａ ｇ ｒｔ ｍ ｔ ａ ｇ ｅ ｔｐ ｏ ｔ ａｕ ． ｈ ｏ Ｋ ｅ ｏ ｄｓ： ａ ａ ｒｐ ｅ ｉｖ ｒｅ ｎ ｌ ｍ ；ＡＤＭ Ｓ ｓ ｆｗａ ｅ；ｖ ｒｕ ｌｐ ｏｏｙ ｅ；ｓｍ ｕ ａｉｎ ｙｗ ｒ ｐｌｎ ｒｔｉｌ ｎ ｅ ｔ ｄ ｐｅ ｄｕ ｕ ｏｔ ｒ ｉ ａ ｒ ｔ ｔｐ ｔ ｉ ｌｔｏ
倒立摆仿真及实验报告
倒立摆仿真及实验报告倒立摆是一种经典的机械系统，它具有丰富的动力学特性，在控制理论和工程应用中得到广泛研究和应用。
本文将对倒立摆的仿真及实验进行详细介绍，并给出相关结果和分析。
1.倒立摆的仿真模型倒立摆的运动可以用以下动力学方程表示：ml^2θ'' + mgl sin(θ) = u - cθ' - Iθ'其中，m是摆杆的质量，l是摆杆的长度，θ是摆杆与垂直方向的夹角，u是外力输入，c是摩擦系数，I是摆杆的转动惯量，g是重力加速度。
为了实现对倒立摆的仿真，我们借助MATLAB/Simulink软件，建立了倒立摆的仿真模型。
模型包括两个部分：倒立摆的动力学模型和控制器。
倒立摆的动力学模型采用上述动力学方程进行描述。
控制器采用经典的PID控制器，其中比例系数Kp、积分系数Ki和微分系数Kd分别用于角度误差的比例、积分和微分控制。
2.倒立摆的仿真结果采用上述模型进行仿真，我们可以得到倒立摆的运动轨迹和角度响应等结果。
根据参数的不同取值，我们可以观察倒立摆的不同运动特性。
首先，我们观察了倒立摆的自由运动。
设置初始条件为摆杆静止且在平衡位置上方一个小角度的偏离。
在没有外力输入的情况下，倒立摆经过一段时间的摆动后最终回到平衡位置，这个过程中摆杆的角度和角速度都发生了变化。
接下来，我们考虑了加入PID控制器后的倒立摆。
设置初始条件为摆杆位于平衡位置上方，并施加一个恒定的外力。
通过调节PID控制器的参数，我们可以使倒立摆保持在平衡位置上方，实现倒立的稳定控制。
当外力发生变化时，控制器能够及时响应并调整摆杆的角度，使其再次回到平衡位置。
3.倒立摆的实验研究为了验证倒立摆的仿真结果，我们进行了实验研究。
实验中，我们采用了具有传感器的倒立摆装置，并连接到PC上进行实时数据采集和控制。
首先，我们对倒立摆进行了辨识。
通过在实验中施加一系列不同的外力输入，我们得到了倒立摆的自由运动数据。
通过对数据进行处理和分析，我们获得了倒立摆的动力学参数。
基于模糊控制的三级倒立摆系统仿真
电机 、皮带轮 、传 动带 以及 电气测 量装置组成 。控制对 象由
小 车 、一 摆 、 二 摆 、 三 摆 组 成 。 一 摆 、二 摆 、 三 摆 由轴 承 连
Ａｂ ｓ ｔ ｒ ａ ｃ ｔ ： Ｉ ｎ ｖ ｅ ｒ ｔ ｅ ｄ ｐ ｅ ｎ ｄ ｕ ｌ ｕ ｍ ｉ ｓ ａ ｌ ｌ ｉ ｄ ｅ ａ ｌ ｅ ｘ ｐ ｅ ｉ ｒ ｍｅ ｎ ｔ ａ ｌ ｏ ｂ ｊ ｅ ｃ ｔ ｉ ｎ ａ ｕ ｔ ｏ ｍａ ｔ ｉ ｃ ｃ ｏ ｎ ｔ ｒ ｏ ｌ ａ ｒ ｅ ａ ． Ｔ ｈ ｅ Ｐ ａ Ｄ ｅ ｒ Ｕ Ｓ ｅ Ｓ ｆ ｕ ｚ ｚ ｙ ｃ ｏ ｎ ｔ ｒ ｏ ｌ ｍｅ ｔ ｈ ｏ ｄ ｔ ｏ ｓ ｔ ｕ ｄ ｙ ｔ ｈ ｅ ｓ ａｂ ｔ ｉ ｌ ｉ ｔ ｙ ｃ ｏ ｎ ｔ ｒ ｏ ｌ ｌ ｎｇ ｉ ｐ ｒ ｏ ｂ ｌ ｅ ｍ ｏ ｆ ｔ ｒ ｉ ｐ ｌ ｅ ｉ ｎ ｖ ｅ ￣ ｅ ｄ ｐ ｅ ｎ ｄ ｕ ｌ ｍ ｕ ｓ ｙ ｓ ｔ ｅ ｍ． Ｔ ｈ ｅ Ｌ Ｑ Ｒ ｏ ｐ ｔ ｉ ｍａ ｌ ｃ ｏ ｎ ｔ ｒ ｏ ｌ ｆ ｅ ｅ ｄ ｂ ａ ｃ ｋ ｗｅ ｉ ｇ ｈ ｔ ｍａ ｔ ｒ ｉ ｘ ｉ ｓ ｄ ｅ ｓ ｉ ｇ ｎ ｅ ｄ
【 关键 词 】 三级 倒 立摆 ；模 糊控 制 ；Ｌ Ｑ Ｒ；仿 真 【 中图分类号】文章编号 】１ ０ ０ ８ — １ １ ５ １ （ ２ ０ １ ５ ） ０ ６ ． ０ ０ ０ ７ — ０ ３
Ｔｒ ｉ ｐｌ ｅ ｉ ｎ ｖ ｅ ｒ ｔ ｅ ｄ ｐｅ ｎｄｕ ｌ ｕｍ ｓ ｙｓ ｔ ｅ ｍ ｓ ｉ ｍ ｕｌ ａ ｔ ｉ ｏ ｎ ｂａ ｓ ｅ ｄ ｏ ｎ ｆ ｕ ｚ ｚ ｙ ｃ ｏ ｎ ｔ ｒ ｏ ｌ
利用ADAMS与MATLAB对平面三级倒立摆的仿真
利用ADAMS与MATLAB对平面三级倒立摆的仿真孔凡国;相飞;钟廷志【摘要】利用ADAMS建立了平面三级倒立摆的虚拟样机模型,并采用ADAMS与MATLAB联合控制的方式,首次完成了平面三级倒立摆的虚拟样机控制仿真.仿真结果表明,尽管X向和Y向系统采用了相同的控制器且初始参数设置完全一样,但仿真结果二者存在一定的区别,这证明了X向和Y向系统存在耦合现象.此外,利用ADAMS与MATLAB联合进行系统的控制仿真,能即时反映控制算法的效果,具有很大的推广价值.%Built in ADAMS planar triple inverted pendulum virtual prototyping model, and uses the ADAMS and MATLAB joint control simulation ways, first completed virtual prototype control simulation of planar triple inverted pendulum. The simulation results show that although X and Y direction system to use the same controller and initial parameters settings exactly the same, but the simulation results to X and Y direction system are different, which proves to X and Y direction system exists coupling phenomenon. In addition, ADAMS and MATLAB joint system control simulation, can reflect the effect of real-time control algorithm, with a great promotion value.【期刊名称】《工业仪表与自动化装置》【年(卷),期】2012(000)003【总页数】3页(P3-4,30)【关键词】三级倒立摆;ADMS软件;虚拟样机;仿真【作者】孔凡国;相飞;钟廷志【作者单位】五邑大学,广东江门529020;五邑大学,广东江门529020;五邑大学,广东江门529020【正文语种】中文【中图分类】TP2730 引言倒立摆系统作为一个高阶次、不稳定、多变量、非线性、强耦合的复杂被控系统［1－2］，在对其控制过程中能有效地反映控制中的许多关键问题，如镇定问题、非线性问题、鲁棒性问题、随动问题以及跟踪问题等，是进行控制理论验证的理想实验平台。
- 1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。
>> T=0:0.02:20;U=zeros(size(T));
>> x0=[0;0.05;-0.05;0.05;0;0;0;0];
>> [Y,X]=lsim(Ac,Bc,Cc,Dc,U,T,x0);
>> figure(1);plot(T,Y(:,1));
B=zeros(8,1);
B(5:8)= M
C=zeros(4,8)
C(1:4,1:4)=eye(4,4);
D=zeros(4,1);
系统的稳定性、能控性及能惯性判断
对于如式（2）式所示的线性定常系统而言，其稳定性可通过计算系统矩阵A的特征值来确定(李雅普诺夫线性系统稳定判据)，如果特征值均处于[S]复平面左半平面，则系统稳定。
>> xlabel('Time/sec');ylabel('02/rad');title('中摆角度变化曲线');grid;
>> figure(4);plot(T,Y(:,4));
>> xlabel('Time/sec');ylabel('03/rad');title('上摆角度变化曲线');grid;
>> xlabel('Time/sec');ylabel('x(小车)/m');title('小车位移');grid;
>> figure(2);plot(T,Y(:,2));
>> xlabel('Time/sec');ylabel('01/rad');title('下摆角度变化曲线');grid;
>> figure(3);plot(T,Y(:,3));
>> Q=[q1 0 0 0 0 0 0 0;0 q2 0 0 0 0 0 0;0 0 q3 0 0 0 0 0;0 0 0 q4 0 0 0 0;0 0 0 0 q5 0 0 0;0 0 0 0 0 q6 0 0;0 0 0 0 0 0 q7 0;0 0 0 0 0 0 0 q8];R=1;
>> [K,P,r2]=lqr(A,B,Q,R)
下摆牛顿定律及动力矩方程：
中摆受力分析：
)
丄摆受力分析：
注： 下，中，上摆质心到铰链处距离；
下，中摆的长度；
；
;
其动力学方程如下⑴：
M( ) =F( ⑴
M( )=
F( )=
N( )=
G=
将此非线性模型在系统的平衡点r= = = =0, 处线性化得到系统的状态方程:
⑵
,
其中：
将参数带入方程计算：
A=
B=
％系统状态方程的重构
％状态变量
( )=( ,zeta )％输出变量Y=X
A=zeros(8,8);
A(1:4,5:8)=eye(4,4);
A(5:8,1:4)= M
A(5:8,5:8)= M ％不用invese而用blackslash是由于blackslash有更好的错误检查机制并且少用时间和内存。
C= D=
控制器设计
根据由图⑴所示的倒立摆系统模型的推导可知，该系统在一定的前提下，可以转变为线性系统#对于线性系统的控制，需要经过系统的稳定性、能控性和能观性判断后才能选择其最优的控制策略#图!显示了式（$）所示的线性系统外控制器的设计过程
状态方程的重构过程，实质上就是本文从式⑴式转化为式⑵式的过程，在MATLAB中，可以用如下代码表示:
Hale Waihona Puke 三级倒立摆摘要：从刚体运动学角度分析了三级倒立摆系统的运动，运用状态空间法对三级倒立摆系统进行数学模型的建立;应用二次型最优控理论实现三级倒立摆控制；最后根据计算结果，通过Matlab程序仿真，得出上中下摆的角度和小车的位移曲线图。
关键词：倒立摆；最优控；仿真；MATLAB
三级倒立摆系统模型
一个典型的三级直线倒立摆系统主要由机电装置和控制装置两部分组成,机电装置的结构见图!
MATLAB中，用函数eig（A）来计算系统矩阵的特征值，经过计算，式⑵式所示的线性定常系统的特征值为：
r1 =[013.27158.39193.1656-18.2950-2.9940-8.5547-13.7810]
因此，该系统为不稳定系统，需加外部控制器形如式（2）所示的线性定常系统能控的充分必要条件是：
>>B=[0;0;0;0;8.72;-29.621;32.238;-3.341];
>> C=[1,0,0,0,0,0,0,0;0,1,0,0,0,0,0,0;0,0,1,0,0,0,0,0;0,0,0,1,0,0,0,0];
>> D=[0;0;0;0];
>> r1=eig(A)
>> q1=500;q2=500;q3=300;q4=100;q5=0;q6=0;q7=0;q8=0;
综上所述，式（2）所示的线性定常系统为不稳定的能控、能观系统，可加外控制器实现系统的稳定。
线性最有调节器的设计
定义状态方程⑵的二次性能指标函数为： ⑶
正定R阵的作用在于限制控制器的输出不会太大而导致难于实现，所以不失一般性，可以将其设为1，LQR方法中，Q阵可以选为非负的对角阵，Q=diag（ ）.各主对角系数的相对大小对系统的整体控制性能有很大的影响，目前普遍采用试探实验的方法来确定加权矩阵Q的系数大小。观察知： 大小的变化对小车的位移影响很大，因为小车位移大小受直线导轨长度的物理限制，所以， 取值可以固定为一个适当大小的数，使小车位移不至过大； ， 次之， 的影响较小。取值时可以去 ,取Q=diag(500,500,300,100,0,0,0,0),R=1.求解Riccati代数方程
rank[B AB… ]=n;
MATLAB中，用“ctrb(A,B)”来求系统能控矩阵 =[B AB… ]的秩，经过计算rank( )=8,系统能控。
形如式（2）所示的线性定常系统能观的充分必要条件为：
MATLAB中，用“obsv(A,C)”来求系统能观阵 的秩，计算的，rank( )=8,系统能观。
PA+ P-PB +Q=0⑷
可以得到状态反馈阵
此时各摆角的动态和稳态指标较为理想。初始条件为 。
仿真结果
程序：
>>A=[0,0,0,0,1,0,0,0;0,0,0,0,0,1,0,0;0,0,0,0,0,0,1,0;0,0,0,0,0,0,0,1;0,-3.6551,0.12698,0.44281,-16.809,0.016897,-0.0056447,-0.0032595;0,45.74,-80.216,-8.3647,57.098,-0.56272,0.32956,-0.072179;0,-49.782,169.9,-4.781,-62.143,0.98145,-0.65964,0.32957;0,-5.159,-114.49,72.269,6.4401,-0.53453,0.51673,-0.76437;];
其主要由摆杆、电机、小车、导轨、传动齿轮、齿条及各种传感器等构成假设系统中的每一根摆杆都是匀质刚体，驱动力与放大器的输入成正比且无延迟地直接作用于小车上，并且可以在忽略实验中的库仑摩擦和动摩擦的前提下，图1所示的倒立摆系统的物理分析：
三级倒立摆受力分析图：
小车受力分析图
下摆受力分析
中摆受力分析
上摆受力分析