现代控制理论-大作业-倒立摆
现代控制理论-大作业-倒立摆

现代控制理论-大作业-倒立摆-标准化文件发布号:(9456-EUATWK-MWUB-WUNN-INNUL-DDQTY-KII摘要倒立摆系统是一个复杂的、高度非线性的、不稳定的高阶系统,是学习和研究现代控制理论最合适的实验装置。
倒立摆的控制是控制理论应用的一个典型范例,一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的。
本文主要研究的是二级倒立摆的极点配置方法,首先用Lagrange方程建立了二级倒立摆的数学模型,然后对二级倒立摆系统的稳定性进行了分析和研究,并给出了系统能控能观性的判别。
基于现代控制理论中的极点配置理论,根据超调量和调整时间来配置极点,求出反馈矩阵并利用Simulink对其进行仿真,得到二级倒立摆的变化曲线,实现了对闭环系统的稳定控制。
关键词:二级倒立摆;极点配置;Simulink目录1.绪论 (1)2 数学模型的建立和分析 (2)2.1 数学建模的方法 (2)2.2 二级倒立摆的结构和工作原理 (2)2.3 拉格朗日运动方程 (3)2.4推导建立数学模型 (4)3 二级倒立摆系统性能分析 (10)3.1 稳定性分析 (10)3.2 能控性能观性分析 (11)4 状态反馈极点配置 (12)4.1 二级倒立摆的最优极点配置1 (12)4.2 二级倒立摆最优极点配置2 (14)5. 二级倒立摆matlab仿真 (16)5.1 Simulink搭建开环系统 (16)5.2 开环系统Simulink仿真结果 (16)5.3 Simulink搭建极点配置后的闭环系统 (17)5.4极点配置Simulink仿真结果 (18)5.4.1 第一组极点配置仿真结果 (18)5.4.2 第二组极点配置仿真结果 (20)6.结论 (22)7.参考文献 (23)附录一 (24)1.绪论倒立摆最初诞生于麻省理工学院,仅有一级摆杆,另一端铰接于可以在直线导轨上自由滑动的小车上。
后来在此基础上,人们又进行拓展,设计出了直线二级倒立摆、环型倒立摆、平面倒立摆、柔性连接倒立摆、多级倒立摆等实验设备。
现代控制一级倒立摆

现代控制一级倒立摆倒立摆实验电子工程学院自动化学号:目录1实验设备简介 (4)1.1倒立摆介绍 (4)1.2直线一级倒立摆 (5)2 倒立摆建模 (6)2.1 直线一阶倒立摆数学模型的推导 (6)2.1.1受力分析 (6)2.1.2微分方程建模 (8)2.1.3状态空间数学模型 (9)2.2 实际系统模型建立 (10)3系统定性、定量分析 (11)3.1系统稳定性与可控性分析 (11)3.1.1稳定性分析 (11)3.1.2能控性分析 (13)4极点配置的设计步骤 (13)4.1极点配置的计算 (13)4.2用MATLAB进行极点配置的计算 (15)4.3极点配置的综合分析 (16)5小结 (17)1实验设备简介1.1倒立摆介绍倒立摆是处于倒置不稳定状态,人为控制使其处于动态平衡的一种摆。
如杂技演员顶杆的物理机制可简化为一级倒立摆系统,是一个复杂,多变量,存在严重非线性,非自制不稳定系统。
常见的倒立摆一般由小车和摆杆两部分组成,其中摆杆可能是一级,二级或多级,在复杂的倒立摆系统中,摆杆的长度和质量均可变化。
1.2直线一级倒立摆根据自控原理实验书上相关资料,直线一级倒立摆在建模时,一般忽略系统中的一些次要因素.例如空气阻力、伺服电机的静摩擦力、系统连接处的松弛程度等,之后可将直线一级倒立摆系统抽象成小车和匀质的杆组成的系统。
倒立摆系统是典型的机电一体化系统其机械部分遵循牛顿的力学定律其电气部分遵守电磁学的基本定理.无论哪种类型的倒立摆系统,都具有3个特性,即:不确定性、耦合性、开环不稳定性. 直线型倒立摆系统,是由沿直线导轨运动的小车以及一端固定于小车上的匀质长杆组成的系统.小车可以通过传动装置由交流伺服电机驱动. 小车导轨一般有固定的行程,因而小车的运动范围是受到限制的。
2 倒立摆建模2.1 直线一阶倒立摆数学模型的推导对于忽略各种摩擦参数和空气阻力之后,直线一即倒立摆抽象为小车和均质杆组成的系统。
倒立摆平台下的现代控制理论综合实验教学方法分析

于一个控制系统的实现往往没有具体的概念 。 通过 对倒立摆系 统的结构及 原理 的认识 , 可 以让学生具 体 的了解一 个控制系统 的实现 。 从理论 上的控制系统概 念到具体 的控制实现 , 改变 了 以往的教条模 式 , 实现了理论与实践的结合。
二、 现代控 制理论综合实验教学改革
学 的倒立摆综合实验 教学 方法。
一
、
倒立摆实验系统 的硬件构成及原理
倒立摆 是指摆 杆处于倒置不稳 定状态 , 能够人为控制使其
处于动 态平衡 的一种机 构,由一个 可以再水平 轨 道上 自由移动
内蒙古科 技大学现代控制理论 教学 大纲要求课堂 教学 3 2 学 时, 实 验8 学时。 为了改善 学生对抽象概 念及理论知识 的认识 , 为了提高学生解 决实 际问题 的能力 , 针对 内蒙 古科技 大学大部 分学 生的基础水平 偏差 的现状 及实验室现有 的设备 , 对现代控
关键词 : 倒 立摆 ; 现 代控 制 理论 ; 综合 实验
作者简介: 张勇( 1 9 8 1 一 ) , 男, 山东临清人, 内蒙古科技大学信息工程学院, 讲师; 贺美琳 ( 1 9 9 1 一 ) , 女, 河北保定人, 内蒙古科技大学信 息工程学院硕士研 究生。( 内蒙古 包头 0 1 4 0 1 0 )
“ 现代 控制 理论 ” 是“ 自动控 制原 理 ”的后 续 课程 , 也是 硕士研 究 生 “ 线性 系统 理论 ”和 “ 最优 控制理 论”等课 程 的基 础课 程 , f I 作 为内蒙古科 技 大学 自动化 本科专业 的基础课 和重 点课 程 ,“ 现代控 制理论 ”的教学改 革多 年来 一直受 到教 师和 学生 的关 注。内蒙古 科技 大学是一所 普通本 科 院校 , 学生普遍 理论 基础 偏差 , 而 现代 控制 理论 对数 学及 相关 理 论 的依 赖较
倒立摆的H∞控制-文献综述

引言近三十年来,随着控制理论技术和航空航天技术的迅猛发展,一种典型的系统在控制理论的领域中一直成为被关注的焦点,即倒立摆系统。
倒立摆的特点为支点在下,重心在上,是一种非常快速并且不稳定的系统。
但正由于它本身所具有的这种特性,许多抽象的控制理论概念如系统稳定性、可控性和系统抗干扰能力等等,都可以通过倒立摆系统实验直观的表现出来。
因此在欧美等许多发达国家的高等院校中,倒立摆系统已经成为必备的控制理论教学实验设备。
学生们可以通过倒立摆系统实验来验证所学的控制理论和算法,非常的直观、简便,更容易对课程加深理解。
倒立摆装置被公认为自动控制理论中的典型实验设备,也是控制理论教学中不可多得的典型物理模型.它深刻揭示了自然界的一种基本规律,即一个自然不稳定的被控对象,运用控制手段可使之具有良好的稳定性.由于倒立摆系统本身所具有的高阶次、不稳定、多变量、非线性和强耦合特性,许多现代控制理论的研究人员一直将它视为典型的研究对象[1-4]。
通过对倒立摆系统的研究,不仅可以解决控制中的理论问题,还能将控制理论所涉及的三个基础学科:力学、数学和电学(含计算机)有机的结合起来,在倒立摆系统中进行综合应用。
在多种控制理论与方法的研究与应用中,特别是在工程实践中,也存在一种可行性的试验问题,将其理论和方法得到有效的经验,倒立摆为此提供了一个从控制理论通往实践的桥梁。
所以,研究倒立摆系统对以后的教育研究领域具有非常深远的影响。
本文为建立倒立摆系统的数学研究模型,在熟悉线性系统的基本理论和非线性系统线性化的基本方法的基础上确定研究的系统方案和实施的控制方法,通过MATLAB软件对其进行编程,以达到完成倒立摆的仿真实验,实现了倒立摆的平衡控制.正文(1)课题的背景及意义倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个典型的快速、高阶次、多变量、非线性、强耦合性、绝对不稳定的系统,可以作为一个典型的控制对象对其进行研究。
matlab仿真毕设--倒立摆现代控制理论研究

内蒙古科技大学本科生毕业设计说明书(毕业论文)题目:倒立摆现代控制理论研究倒立摆现代控制理论研究摘要倒立摆系统是一个复杂的非线性、强耦合、多变量和自不稳定系统。
在控制工程中,它能有效地反映诸如可镇定性、鲁棒性、随动性以及跟踪性等许多控制中的关键问题,是检验各种控制方法的理想工具。
理论是工程的先导,它对倒立摆系统的控制研究具有重要的工程背景,单级倒立摆与火箭的飞行有关,二级倒立摆与双足机器人的行走有相似性,日常生活中的任何重心在上,支点在下的问题都与倒立摆的控制有极大的相似性,所以对倒立摆的稳定控制有重大的现实意义。
迄今,人们已经利用古典控制理论、现代控制理论及多重智能控制理论实现了多种倒立摆系统的稳定控制[5]。
倒立摆的控制方法有很多,如状态反馈控制,经典PID控制,神经网络控制,遗传算法控制,自适应控制,模糊控制等。
其控制方法已经在军工、航天、机器人和一般工业过程等领域得到了应用。
因此对倒立摆系统的控制研究具有重要的理论和现实意义,成为控制领域中经久不衰的研究课题。
本文是应用线性系统理论中的极点配置、线性二次型最优(LQR)和状态观测器等知识,设计了倒立摆系统线性化模型的控制器,通过MA TLAB仿真,研究其正确性和有效性。
通过分析仿真结果,我们知道了,状态反馈控制可以使倒立摆系统很好的控制在稳定状态,并具有良好的鲁棒性。
关键词:倒立摆;现代控制;Matlab仿真;Modern Control Theory Of Inverted PendulumAbstractInverted pendulum system is a complex nonlinear and strongly coupled,multi-variable and unstable system since.In control engineering,it can effectively reflect such stabilization,robustness,with the mobility of control and tracking,and many other key issue,It is the test ideal for a variety of control methods.Theory is the project leader,inverted pendulum control system also has important engineering research background,inverted pendulum with single-stage related torocket for the flight,Inverted pendulum and biped walking robot similar nature in any life in the center of gravity,the fulcrum in the next issue with the inverted pendulum control has a great similarity,so the stability control of inverted pendulum significant practical significance.So far,it has been the use of classical control theory,modern control theory and control theory of multiple intelligence to achieve a variety of inverted pendulum system stability control[5].Inverted pendulum control methods there are many,such as the state feedback control,the classic PID control,neural network control,genetic algorithm control,adaptive control,fuzzy control.The control method has been in military,aerospace,robotics and general industrial processes and other areas have been intended use.Therefore,the control of inverted pendulum system research has important theoretical and practical significance,of becoming enduring research topics in the field.This is the application of the theory of linear systems pole placement,linear quadratic optimal (LQR) and the state observer of such knowledge,the design of the linear inverted pendulum model of the controller,through simulation to study the correctness and effective sex.By analyzing the results of MATLAB simulation,state feedback control can make a goodcontrol of inverted pendulum system in a stable state,and has good robustness,stability control features.Key words: Inverted pendulum;Modern control;Matlab simulation;目录摘要 (I)Abstract (II)第一章绪论 (1)1.1倒立摆系统模型简介 (1)1.2倒立摆研究的背景与意义 (2)1.3国内外研究现状、水平和发展趋势 (3)1.3.1倒立摆和控制理论的发展 (3)1.3.2倒立摆的控制方法 (4)1.3.3倒立摆的发展趋势 (5)1.4本论文的主要工作介绍 (6)第二章一级倒立摆的数学模型建立及其性能分析 (7)2.1 系统的组成 (7)2.2 一级倒立摆数学模型的建立 (8)2.2.1 数学模型的建立 (8)2.2.2 系统的结构参数 (9)2.2.3 用牛顿力学方法来建立系统的数学模型 (9)2.2.4 一级倒立摆的性能分析[7] (13)2.3 本章小结 (15)第三章现代控制理论在倒立摆控制中的应用 (16)3.1 自动控制理论的发展历程 (16)3.2 经典控制理论 (18)3.2.1 PID控制现状 (18)3.2.2 PID控制的基本原理 (18)3.2.3 常用PID数字控制系统 (20)3.3 现代控制理论 (21)3.3.1 极点配置[11] (22)3.3.2 线性二次型最优的控制理论[7,8] (24)3.3.3 加权矩阵的选取 (26)3.3.4 状态观测器[7] (26)3.4 本章小结 (29)第四章MA TLAB仿真技术 (30)4.1 仿真软件——Matlab简介 (30)4.1.1 MA TLAB的优势 (30)4.2 Simulink简介 (32)4.3 S-函数简介 (33)4.3.1 用M文件创建S-函数 (34)4.4 倒立摆仿真模块的建立 (36)4.5 本章小结 (37)第五章一级倒立摆线性模型系统的仿真 (38)5.1 倒立摆控制器结构选择 (38)5.2 一级倒立摆线性模型系统仿真 (38)5.2.1 Simulink仿真 (42)5.3 本章小结 (46)结束语 (48)参考文献 (49)附录A (51)致谢 (53)第一章绪论1.1倒立摆系统模型简介倒立摆控制系统是一个复杂的、不稳定的、非线性的系统,是进行控制理论教学及开展各种控制实验的理想实验平台,但它并不是我们想象的那样抽象,其实在我们日常生活中就有很多这样的例子。
倒立摆创新实践报告

一、倒立摆系统介绍1、倒立摆系统简介倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。
GIP 系列倒立摆系统是固高科技有限公司,为全方位满足各类电机拖动和自动控制课程的教学需要,而研制、开发的实验教学平台。
GIP 系列的主导产品由直线运动型、旋转运动型和平面运动型三个子系列组成。
虽然倒立摆的形式和结构各异,但所有的倒立摆都具有以下的特性:非线性: 倒立摆是一个典型的非线性复杂系统,实际中可以通过线性化得到系统的近似模型,线性化处理后再进行控制,也可以利用非线性控制理论对其进行控制,倒立摆的非线性控制正成为一个研究的热点。
不确定性: 主要是模型误差以及机械传动间隙,各种阻力等,实际控制中,一般通过减少各种误差,如通过施加预紧力减少皮带或齿轮的传动误差,利用滚珠轴承减少摩擦阻力等不确定因素。
耦合性:主要是模型误差以及机械传动间隙,各种阻力等,实际控制中一立摆的各级摆杆之间,以及和运动模块之间都有很强的耦合关系,倒立摆控制中一般都在平衡点附近进行解耦计算,忽略一些次要的耦合量。
开环不稳定性: 倒立摆的稳定状态只有两个,即在垂直向上的状态和垂直向下的状态,其中垂直向上为绝对不稳定的平衡点,垂直向下为稳定的平衡点。
约束限制:由于机构的限制,如运动模块行程限制,电机力矩限制等。
为制造方便和降低成本,倒立摆的结构尺寸和电机功率都尽量要求最小,行程限制对于倒立摆的摆起尤为突出,容易出现小车的撞边现象。
倒立摆作为典型的快速、多变量,高阶非线形不稳定系统,一直是控制领域研究的热点。
它不但是验证现代控制理论方法的典型实验装置,而且其控制方法在一般工业过程中亦有着广泛的应用。
对倒立摆控制系统的研究可归结为非线形多变量绝对不稳定系统的研究。
早期的倒立摆控制律大多采用状态反馈,近年来,随着智能控制理论的发展,有人开始将模糊控制算法,神经网络用于倒立摆的控制。
现代控制理论实验报告

倒立摆控制系统实验报告实验一建立一级倒立摆的数学模型一、实验目的学习建立一级倒立摆系统的数学模型,并进行Matlab仿真。
二、实验内容写出系统传递函数和状态空间方程,用Matlab进行仿真。
三、Matlab源程序及程序执行结果⑴Matlab源程序⑵给出系统的传递函数和状态方程传递函数gs(输出为摆杆角度)传递函数gspo(输出为小车位置)状态空间sys(A,B,C,D)⑶给出传递函数极点和系统状态矩阵A的特征值传递函数gs极点P传递函数gspo极点Po系统状态矩阵A的特征值E⑷给出系统开环脉冲响应和阶跃响应的曲线系统开环脉冲响应曲线系统开环阶跃响应曲线四、思考题(1) 由状态空间方程转化为传递函数,是否与直接计算传递函数相等?通过比较,可知传递函数gspo由状态空间方程转化为传递函数时,多了s的一次项,但是系数可以近似为0。
传递函数gs,则完全相等。
所以,状态空间方程转化为传递函数与直接计算传递函数可以认为是相等的。
(2) 通过仿真表明开环系统是否稳定?请通过极点(特征值)理论来分析。
开环系统不稳定。
根据极点理论可知,系统稳定的条件是极点均在左半平面。
但是,系统有一个极点5.4042不在左半平面。
因此,系统不稳定(3) 传递函数的极点和状态方程的特征值的个数、大小是否相等?如果不相等,请解释其原因。
传递函数gspo的极点和状态方程的特征值的个数、大小相等。
但是传递函数gs的极点和状态方程的特征值个数不相等。
因为存在零极点对消。
Matlab源程序:clear all;f1=0.001;%实际系统参数M=1.32;m=0.132;b=0.1;l=0.27;I=0.0032;g=9.8;T=0.02;%求传递函数gs(输出为摆杆角度)和gspo(输出为小车位置)q=(M+m)*(I+m*l^2)-(m*l)^2;num=[m*l/q 0];den=[1 b*(I+m*l^2)/q -(M+m)*m*g*l/q -b*m*g*l/q];gs=tf(num,den);numpo=[(I+m*l^2)/q 0 -m*g*l/q];denpo=[1 b*(I+m*l^2)/q -(M+m)*m*g*l/q -b*m*g*l/q 0];gspo=tf(numpo,denpo);%求状态空间sys(A,B,C,D)p=I*(M+m)+M*m*l^2;A=[0 1 0 0;0 -(I+m*l^2)*b/p m^2*g*l^2/p 0;0 0 0 1;0 -m*b*l/p m*g*l*(M+m)/p 0];B=[0;(I+m*l^2)/p;0;m*l/p];C=[1 0 0 0;0 0 1 0];D=[0;0];sys=ss(A,B,C,D);%通过传递函数求系统(摆杆角度和小车位置)的开环脉冲响应t=0:T:5;y1=impulse(gs,t);y2=impulse(gspo,t);figure(1);plot(t,y2,'b',t,y1,'r');xlabel('t/s');ylabel('Position/m or Angle/rad');axis([0 2 0 80]);legend('Car Position','Pendulum Angle');%将状态空间方程sys转化为传递函数gs0gs0=tf(sys);%通过状态方程求系统(摆杆角度和小车位置)的开环脉冲响应t=0:T:5;y=impulse(sys,t);figure(2);plot(t,y(:,1),t,y(:,2),'r');xlabel('t/s');ylabel('Position/m or Angle/rad');axis([0 2 0 80]);legend('Car Position','Pendulum Angle');%通过传递函数求系统(摆杆角度和小车位置)的开环阶越响应t=0:T:5;y1=step(gs,t);y2=step(gspo,t);figure(3);plot(t,y2,'b',t,y1,'r');axis([0 2.5 0 80]);xlabel('t/s');ylabel('Position/m or Angle/rad');legend('Car Position','Pendulum Angle');%通过状态方程求系统(摆杆角度和小车位置)的开环阶越响应t=0:T:5;y=step(sys,t);figure(4);plot(t,y(:,1),t,y(:,2),'r');xlabel('t/s');ylabel('Position/m or Angle/rad');axis([0 2.5 0 80]);legend('Car Position','Pendulum Angle');%求传递函数极点P=pole(gs);Po=pole(gspo);%求A的特征值E=eig(A);实验二倒立摆系统控制算法的状态空间法设计一、实验目的学习如何使用状态空间法设计系统的控制算法。
现代控制理论大作业倒立摆

摘要倒立摆系统是一个复杂的、高度非线性的、不稳定的高阶系统,是学习和研究现代控制理论最合适的实验装置。
倒立摆的控制是控制理论应用的一个典型范例,一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的。
本文主要研究的是二级倒立摆的极点配置方法,首先用Lagrange方程建立了二级倒立摆的数学模型,然后对二级倒立摆系统的稳定性进行了分析和研究,并给出了系统能控能观性的判别。
基于现代控制理论中的极点配置理论,根据超调量和调整时间来配置极点,求出反馈矩阵并利用Simulink对其进行仿真,得到二级倒立摆的变化曲线,实现了对闭环系统的稳定控制。
关键词:二级倒立摆;极点配置;Simulink目录1.绪论.........................................................2 数学模型的建立和分析......................................... 数学建模的方法................................................ 二级倒立摆的结构和工作原理.................................... 拉格朗日运动方程.............................................. 推导建立数学模型...............................................3 二级倒立摆系统性能分析.......................................稳定性分析..................................................能控性能观性分析............................................4 状态反馈极点配置.............................................二级倒立摆的最优极点配置1 ..................................二级倒立摆最优极点配置2 ......................................5. 二级倒立摆matlab仿真....................................... Simulink搭建开环系统......................................... 开环系统Simulink仿真结果..................................... Simulink搭建极点配置后的闭环系统............................. 极点配置Simulink仿真结果...................................... 第一组极点配置仿真结果........................................ 第二组极点配置仿真结果........................................6.结论.........................................................7.参考文献..................................................... 附录一.........................................................1.绪论倒立摆最初诞生于麻省理工学院,仅有一级摆杆,另一端铰接于可以在直线导轨上自由滑动的小车上。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
摘要倒立摆系统是一个复杂的、高度非线性的、不稳定的高阶系统,是学习和研究现代控制理论最合适的实验装置。
倒立摆的控制是控制理论应用的一个典型范例,一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的。
本文主要研究的是二级倒立摆的极点配置方法,首先用Lagrange 方程建立了二级倒立摆的数学模型,然后对二级倒立摆系统的稳定性进行了分析和研究,并给出了系统能控能观性的判别。
基于现代控制理论中的极点配置理论,根据超调量和调整时间来配置极点,求出反馈矩阵并利用Simulink对其进行仿真,得到二级倒立摆的变化曲线,实现了对闭环系统的稳定控制。
关键词:二级倒立摆;极点配置;Simulink目录1.绪论 (1)2 数学模型的建立和分析 (1)2.1 数学建模的方法 (1)2.2 二级倒立摆的结构和工作原理 (2)2.3 拉格朗日运动方程 (3)2.4推导建立数学模型 (4)3 二级倒立摆系统性能分析 (10)3.1 稳定性分析 (10)3.2 能控性能观性分析 (11)4 状态反馈极点配置 (12)4.1 二级倒立摆的最优极点配置1 (12)4.2 二级倒立摆最优极点配置2 (13)5. 二级倒立摆matlab仿真 (15)5.1 Simulink搭建开环系统 (15)5.2 开环系统Simulink仿真结果 (15)5.3 Simulink搭建极点配置后的闭环系统 (16)5.4极点配置Simulink仿真结果 (17)5.4.1 第一组极点配置仿真结果 (17)5.4.2 第二组极点配置仿真结果 (19)6.结论 (20)7.参考文献 (21)附录一 (22)1.绪论倒立摆最初诞生于麻省理工学院,仅有一级摆杆,另一端铰接于可以在直线导轨上自由滑动的小车上。
后来在此基础上,人们又进行拓展,设计出了直线二级倒立摆、环型倒立摆、平面倒立摆、柔性连接倒立摆、多级倒立摆等实验设备。
在控制理论的发展过程中,为验证某一理论在实际应用中的可行性需要按其理论设计的控制器去控制一个典型对象来验证。
倒立摆系统作为一个实验装置,形象直观,结构简单,成本低廉;作为一个控制对象,他又相当复杂,同时就其本身而言,是一个高阶次、不稳定、多变量、非线性、强耦合系统,只有采取行之有效的控制方法才能使之稳定,因此倒立摆装置被公认为是自动控制理论中的典型实验设备。
综合文献资料,倒立摆控制的方法主要有:PID控制,状态反馈,利用云模型,神经网络控制,遗传算法,自适应控制,模糊控制,变论域自适应模糊控制理论,智能控制等多种算法来实现倒立摆的控制。
本文主要构建二级倒立摆的数学模型的建立与分析,对倒立摆系统进行控制方法的研究。
本文就以下几个问题进行了论述。
1.二级倒立摆的数学模型的建立与分析。
在建模部分,首先采用拉格朗日方程推导数学模型,并对系统的可控性可观性进行分析,并分析倒立摆系统控制的难易程度。
2.二级倒立摆的控制原理及方法的研究。
本文主要采用状态反馈极点配置的方法对二级倒立摆进行研究。
3.采用Matlab语言进行数字仿真,分析仿真结果。
2 数学模型的建立和分析2.1 数学建模的方法所谓系统的数学模型就是利用数学结构来反映系统内部之间、内部与外部某些因素之间的精确的定量的表示。
它是分析、设计、预报和控制一个系统的基础,所以要对一个系统进行研究,首先要建立它的数学模型。
建立倒立摆系统的模型时,一般采用牛顿运动规律,结果要解算大量的微分方程组,而且考虑到质点组受到的约束条件,建模问题将更加复杂,为此本文采用分析力学方法中的Lagrange方程推导倒立摆的系统模型。
Lagrange方程有如下特点:1.它是以广义坐标表达的任意完整系统的运动方程式,方程式的数目和系统的自由度是一致的。
2.理想约束反力不出现在方程组中,因此在建立运动方程式时,只需分析已知的主动力,而不必分析未知的约束反力。
grange方程是以能量观点建立起来的运动方程,为了列出系统的运动方程,只需要从两个方面去分析,一个是表征系统运动的动力学量-系统的动能,另一个是表征主动力作用的动力学量-广义力。
因此用Lagrange方程来求解系统的动力学方程可以大大简化建模过程。
2.2 二级倒立摆的结构和工作原理如图 2.1,系统包括计算机、运动控制卡、伺服机构、倒立摆本体(小车,上摆,下摆,皮带轮等)和光电码盘几大部分,组成了一个闭环系统。
光电码盘1将小车的位移、速度信号反馈给伺服驱动器和运动控制卡,下面一节摆杆(和小车相连)的角度、角速度信号由光电码盘2反馈回控制卡和伺服驱动器,上面一节摆杆的角度和角速度信号则由光电码盘3反馈。
计算机从运动控制卡中读取实时数据,确定控制决策(小车向哪个方向移动、移动速度、加速度等),并由运动控制卡来实现该控制决策,产生相应的控制量,使电机转动,带动小车运动,保持两节摆杆的平衡。
图2.1 系统结构和工作原理图2.3 拉格朗日运动方程拉格朗日提出了用能量的方法推导物理系统的数学模型,首先我们引入广义坐标,拉格朗日方程。
广义坐标:系统的广义坐标是描述系统运动必需的一组独立坐标,广义坐标数等同于系统自由度数。
如果系统的运动用n维广义坐标q1,q2,…q n来表示,我们可以把这n维广义坐标看成是n维空间的n位坐标系中的坐标。
对于任一系统可由n维空间中的一点来表征。
系统在n维空间中运动形成的若干系统点连成一条曲线,此曲线表示系统点的轨迹。
拉格朗日方程:L(q,q̇)=T(q,q̇)−V(q,q̇)(2.1) 式中,L——拉格朗日算子,q——系统的广义坐标,T——系统的动能,V——系统的势能。
拉格朗日方程由广义坐标i q和L表示为:d dt ðLðq i−ðLðq i=f i(2.2)式中,n i 3,2,1=,i f ——系统沿该广义坐标方向上的外力,在本系统中,设系统的三个广义坐标分别是21,,θθx 。
2.4推导建立数学模型在推导数学模型之前,我们需要几点必要的假设: 1.上摆、下摆及小车均是刚体;2.皮带轮与传动带之间无相对滑动;传动皮带无伸长现象;3.小车运动时所受的摩擦力正比于小车的速度;4.小车的驱动力与直流放大器的输入成正比,且无滞后,忽略电机电枢绕组中的电感;5.下摆转动时所受到的摩擦力矩正比于下摆的转动速度;6.上摆运动时所受到的摩擦力矩正比于上摆对下摆的相对角速度; 二级倒立摆的运动分析示意图如图2.2图2.2 二级倒立摆运动分析示意图倒立摆系统参数如下: 小车系统的等效质量M =1.32Kg 摆杆1 质量1m =0.04Kg 摆杆1 转动中心到杆质心距离1l =0.09m 摆杆2 质量m 2=0.132Kg 摆杆2 转动中心到杆质心距离l 2=0.27m 质量块质量3m =0.208Kg作用在系统上的外力FyxxF m 1m 3 θ2m 2M摆杆1 与垂直向上方向的夹角1θ 摆杆2 与垂直向上方向的夹角2θ 首先,计算系统的动能:321m m m M T T T T T +++=(2.3)M T 小车动能:T M =12Mẋ2(2.4)1m T 摆杆1动能:111m m m T T T ''+'=(2.5)式中,T m1′--摆杆1质心平东动能T m1′′--摆杆1绕质心转动动能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)式中,T m2′--摆杆1质心平东动能T m2′′--摆杆1绕质心转动动能22'11221122222(2sin sin (2cos cos )1122m d x l l d l l T m m dt dt θθθθ--+⎛⎫⎛⎫=+ ⎪ ⎪⎝⎭⎝⎭()()22211122*********12cos 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 m11121213111323cos 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θθθθθθθθθxm 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 ⎡⎤⎢⎥=⎢⎥⎢⎥⎣⎦3 二级倒立摆系统性能分析3.1 稳定性分析二级倒立摆的特征方程为:det()0I A λ-= (3.1)Matlab 中,用函数eig(A )来计算系统矩阵的特征值,经过计算,系统的特征值为:[]9.5972 4.77259.5972 4.772500λ=-- (3.2) 开环系统有两个开环极点位于S 平面右半平面上,所以系统是不稳定的。