二级倒立摆的建模与MATLAB仿真-毕业论文.doc

《二级倒立摆的建模与MATLAB仿真-毕业论文.doc》由会员上传分享，免费在线阅读，更多相关内容在学术论文-天天文库。

1、第7页共7页二级倒立摆的建模与MATLAB仿真二级倒立摆的建模与MATLAB仿真摘要：本文根据牛顿力学原理，使用机理建模法对二级倒立摆系统进行了建模与仿真研究。利用最优化控制理论，研究了线性二次型最优控制器对倒立摆系统进行了有效控制。基于MATLAB程序的设计、仿真的运行，结果表明，二级倒立摆的数学建模法是切实可行的，而且十分可靠，同时利用LQR控制器实现了对系统的控制，可以达到系统所需要的稳定性，鲁棒性。关键词：二次型最优控制；二级倒立摆；MATLAB1引言倒立摆系统是一个常用的、简单的、典型的可进行控制理论研究的实验平台，很多难以用常规实验研究的控制理论问题，都可以通过倒立摆系统来进行研

2、究从而使这些抽象的控制理论问题，通过该系统可以直观的鲜明的显示出来。所以倒立摆系统一直是控制领域的热点，并且在这些年来在不断的发展进步对控制理论的研究起到了重要作用。倒立摆系统是一个典型的不稳定系统，具有多变量、强耦合、非线性等特点。同时也是仿人类行走机器人和火箭发射飞行的过程调整和直升机飞行等实际运用控制对象的最简模型。本文建立在牛顿力学定律的基础上，研究对象设置为二级倒立摆，对其进行数学建模，再使用二次型最优控制器（linearquadraticregulator，LQR）可以得到一个最优状态反馈的矩阵K，然后在通过对Q和R两个加权矩阵的严谨选取从而实现对二级倒立摆系统良好的自动控制。2

3、二级倒立摆模型建立一个典型的二级倒立摆系统主要由机械部分和电气装置两部分组成。机械装置的结构主要由小车、摆杆1、摆杆2及连接轴等组成，电气装置的主要结构是功率放大器、电动机、驱动电路、保护电路等。其系统的结构如图1所示。实验假设如下：(1)小车、摆杆1、摆杆2的材料性质都是刚体的。(2)小车的驱动力和放大器的输出直接的，无滞后的作用于小车上。(3)忽略实验中过程中出现的不可避免的各种摩擦力如库伦摩擦力等。第7页共7页二级倒立摆的建模与MATLAB仿真图1二级倒立摆控制系统的结构二级倒立摆的参数设定如表1。表1二级倒立摆的参数设定M小车质量1.328kg摆杆2中心到杆心距离0.222m摆杆1质

4、量0.21kgF作用在系统上的外力22.916摆杆2质量0.186kgg重力加速度9.8m/s2质量块质量0.206kg摆杆1中心到杆心距离0.312m通过拉格朗日定律的利用，建立相应的系统模型：可设小车的总动能为，摆杆1的动能为，摆杆二的动能为，质量块的动能为，可得出系统的总动能为：(1)由（1）可得系统的总动能为：+－2+(2)系统的势能为：=(3)第7页共7页二级倒立摆的建模与MATLAB仿真由（2）可得系统的势能为：(4)拉格朗日算子：(5)因为在广义坐标上可忽略外力的作用，那么即可建立以下的模型方程：,(6)因为(7)(8)(9)(10)根据泰勒公式，在平衡处展开，并利用线性化对方

5、程进行计算可得到以下方程组：(11)将公式（6）代入（11）可得：(12)将公式（7）(8)(9)(10)代入（12）可解出：第7页共7页二级倒立摆的建模与MATLAB仿真(13)设变量，，，，，，加速度为，代入,可得输出方程：=+(14)+(15)3LQR算法我们运用线性二次型最优控制器(linearquadraticregulator-LQR)对系统进行控制。LQR是能以控制和状态变量为指标的动态系统最优控制方法,在现代控制理论中有非常重要的意义。（1）若给定系统的状态方程为,。(16)（2）用表示系统的期望输出。（3）定义为系统的向量误差。则指标函数为：(17)在倒立摆系统中,，所以，

6、而且倒立摆的控制是第7页共7页二级倒立摆的建模与MATLAB仿真趋向于无穷大时系统的状态问题，所以指标函数为：(18)其中是系统的反馈控制，其中是系统方程的唯一正定解。因为在二级倒立摆的系统中，小车的主要被控量是小车的位移和它上下摆的角度，是状态变量的影响力，是对的加权在试验中我们可选取,运用MATLAB结果分析可证明二级单摆系统是能控，能观的，将表一带入公式（13）可得出系统的状态反馈矩阵为：（31.6228136.1926193.416644.8083-127.8892-17.8342）4仿真分析根据上述分析的二级倒立摆控制系统数学模型和LQR算法，运用MATLAB仿真软件，该系统的控制

7、仿真程序如下：K=[31.6228136.1926193.416644.8083-127.8892-17.8342];A=[010000;0-16.6601-1.297300.08570;000100;039.055518.05140-7.86030;000001;0-68.5120-14.4458025.96350];B=[0;0.7270;0;-1.7044;0;0.2069];C=[100000;010