电气系统综合设计实验报告直线一级倒立摆控制系统设计

合集下载

直线一级倒立摆---开题报告-范例

直线一级倒立摆---开题报告-范例
主要内容:
设计及制作倒立摆系统,建立倒立摆系统的数学模型,推导出倒立摆的传递函数和状态方程,并用MATLAB软件仿真,验证系统的稳定性。
设计倒立摆PID控制器,用MATLAB仿真并实物调式。设计倒立摆系统的状态空间极点配置控制器,用MATLAB仿真及实物调式。
三、研究方法和手段
一、研究方法:
1.文献研究法
xxx学院
本科毕业论文(设计)开题报告
二级学院:xxxxxxxxx
学号
姓名
专业
自动化
年级班别
2012级3班
论文(设计)题目
直线一级倒立摆控制系统的设计
拟完成时间
2016年4月10日
指导教师姓名及职称
xxx讲师
题目类型
囗 理论研究 囗 应用研究设计开发 囗 其他
命题来源
教师命题囗学生自主命题囗教师科研课题
[9]陈华.单级倒立摆智能控制器的设计[J].重庆工学院学报(自然科学版),2009,23(01):98-101+156.
[10]杨燕.一级倒立摆系统的快速稳定方法研究[J].自动化与仪器仪表,2015,35(10):166-168.
五、文献综述
倒立摆是机器人技术、控制理论、计算机控制等多个领域,多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。
稳定控制器的设计是倒立摆系统的核心内容,同时我认为也是本次设计的难点所在。怎样使得摆杆尽快地达到平衡状态,以及怎样尽量增强系统的抗干扰能力,是研究倒立摆系统的重点内容。本设计将采用单片机作为控制中心,其主要由倒立摆框架,传感器模块及电机驱动模块等组成,能够控制小车前后运动并使连接在小车上的摆杆倒立。小车的动力由一个直流减速电机提供,摆杆旋转端固定一精密角度传感器。旋转过程中,精密角度传感器实时检测并反馈角度信号给单片机,单片机通过对信号的处理,使电机在驱动模块的作用下转动,摆杆的角度作为控制装置的反馈量,控制装置通过PID控制算法来控制电机的转速与转向,最后来实现摆杆的倒立。

一级倒立摆【控制专区】系统设计

一级倒立摆【控制专区】系统设计

基于双闭环PID控制的一阶倒立摆控制系统设计一、设计目的倒立摆是一个非线性、不稳定系统,经常作为研究比较不同控制方法的典型例子。

设计一个倒立摆的控制系统,使倒立摆这样一个不稳定的被控对象通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统。

二、设计要求倒立摆的设计要求是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡和过大的角度和速度。

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

实验参数自己选定,但要合理符合实际情况,控制方式为双PID控制,并利用MATLAB进行仿真,并用simulink对相应的模块进行仿真。

三、设计原理倒立摆控制系统的工作原理是:由轴角编码器测得小车的位置和摆杆相对垂直方向的角度,作为系统的两个输出量被反馈至控制计算机。

计算机根据一定的控制算法,计算出空置量,并转化为相应的电压信号提供给驱动电路,以驱动直流力矩电机的运动,从而通过牵引机构带动小车的移动来控制摆杆和保持平衡。

四、设计步骤首先画出一阶倒立摆控制系统的原理方框图一阶倒立摆控制系统示意图如图所示:分析工作原理,可以得出一阶倒立摆系统原理方框图:一阶倒立摆控制系统动态结构图下面的工作是根据结构框图,分析和解决各个环节的传递函数!1.一阶倒立摆建模在忽略了空气流动阻力,以及各种摩擦之后,可将倒立摆系统抽象成小车和匀质杆组成的系统,如下图所示,其中: M :小车质量 m :为摆杆质量 J :为摆杆惯量 F :加在小车上的力 x :小车位置θ:摆杆与垂直向上方向的夹角 l :摆杆转动轴心到杆质心的长度根据牛顿运动定律以及刚体运动规律,可知: (1) 摆杆绕其重心的转动方程为(2) 摆杆重心的运动方程为得sin cos ..........(1)y x J F l F l θθθ=-2222(sin ) (2)(cos ) (3)x y d F m x l d td F mg m l d t θθ=+=-(3)小车水平方向上的运动为22..........(4)x d xF F M d t-=联列上述4个方程,可以得出一阶倒立精确气模型:()()()()()()()2222222222222222sin .sin cos cos cos .sin cos .lg sin cos J ml F ml J ml m l g x J ml M m m l ml F m l M m m m l M m J ml θθθθθθθθθθθθ⎧+++-⎪=++-⎪⎨+-+⎪=⎪-++⎩式中J 为摆杆的转动惯量:32ml J =若只考虑θ在其工作点附近θ0=0附近(︒︒≤≤-1010θ)的细微变化,则可以近似认为:⎪⎩⎪⎨⎧≈≈≈1cos sin 02θθθθ ⎪⎪⎩⎪⎪⎨⎧++-+=++-+=2..2222..)(lg )()()(Mml m M J mlF m m M Mml m M J g l m F ml J x θθθ 若取小车质量M=2kg,摆杆质量m=1kg,摆杆长度2 l =1m,重力加速度取g=2/10s m ,则可以得 一阶倒立摆简化模型:....0.44 3.330.412x F F θθθ⎧=-⎪⎨⎪=-+⎩即 G 1(s)= ; G 2(s)=一阶倒立摆环节问题解决!2.电动机驱动器选用日本松下电工MSMA021型小惯量交流伺服电动机,其有关参数如下:222()0.4()12() 1.110()s F s s x s s s s θθ-⎧=⎪-⎪⎨-+⎪=⎪⎩驱动电压:U=0~100V 额定功率:PN=200W 额定转速:n=3000r/min 转动惯量:J=3×10-6kg.m2 额定转矩:TN=0.64Nm 最大转矩:TM=1.91Nm 电磁时间常数:Tl=0.001s 电机时间常数:TM=0.003s经传动机构变速后输出的拖动力为:F=0~16N ;与其配套的驱动器为:MSDA021A1A ,控制电压:UDA=0~±10V 。

一级直线倒立摆系统模糊控制器设计---实验指导书

一级直线倒立摆系统模糊控制器设计---实验指导书

一级直线倒立摆系统模糊控制器设计实验指导书目录1 实验要求................................................................................. . (3)1.1 实验准备................................................................................. . (3)1.2 评分规则................................................................................. . (3)1.3 实验报告容................................................................................. .. (3)1.4 安全注意事项................................................................................. .. (3)2 倒立摆实验平台介绍................................................................................. .. (4)2.1 硬件组成................................................................................. . (4)2.2 软件结构................................................................................. . (4)3 倒立摆数学建模(预习容) .............................................................................. (6)4 模糊控制实验................................................................................. (8)4.1 模糊控制器设计(预习容)............................................................................... (8)4.2 模糊控制器仿真................................................................................. (12)4.3 模糊控制器实时控制实验................................................................................. .. (12)5 附录:控制理论中常用的MATLAB 函数................................................................................. (13)6 参考文献............ .................................................................... (14)1 实验要求1.1 实验准备实验准备是顺利完成实验容的必要条件。

(完整word版)一级倒立摆的LQR控制器设计(一)

(完整word版)一级倒立摆的LQR控制器设计(一)

沈阳航空航天大学课程设计(论文)题目一级倒立摆的LQR控制器设计(一)班级04070202学号2010040702069学生姓名杨贺指导教师目录0。

前言.。

.。

.。

.。

.。

..。

.。

...。

..。

..。

.。

.。

.。

.。

..。

...。

.。

...。

.。

.。

..。

..。

........。

..。

...。

.。

.。

.。

.。

.。

....。

..。

.....。

.。

.。

10。

1 倒立摆的背景及简介...。

.。

.。

...。

....。

.。

.。

.。

..。

.。

...。

.。

.。

.。

...。

.....。

....。

.。

.。

.。

..。

.。

.。

....。

.。

.。

.10.2 MATLAB简介及应用....。

..。

.。

..。

..。

..。

..。

.....。

..。

..。

.。

.。

.。

.。

..。

..。

.。

.。

..。

..。

..。

..。

.。

...。

.。

.。

11。

一级倒立摆模型和线性二次最优控制LQR基本理论.。

...。

.。

.。

.。

.。

..。

....。

.。

.。

.。

.。

..。

....。

.。

(4)1。

1 一级倒立摆模型基本理论。

..。

...。

...。

..。

...。

.。

.。

.。

.。

...。

...。

.。

.。

....。

..。

..。

...。

..。

.。

...。

.。

41.2 线性二次最优控制LQR基本理论.。

...。

.。

..。

...。

.。

.。

..。

.。

...。

.。

.。

.。

...。

......。

..。

.。

..。

72. 方案设计。

.......。

.。

.。

...。

.。

.。

....。

.。

..。

......。

....。

..。

.。

....。

.。

..。

.。

.。

. ..。

.。

.。

.。

..。

.。

.。

.。

...。

...。

.....。

103。

软件编程。

.。

.。

.。

.。

.。

...。

..。

...。

...。

..。

...。

.。

.。

.。

..。

.。

.。

..。

.。

.。

..。

析.。

...。

.。

.....。

...。

.。

.。

...。

.。

..。

...。

.。

..。

.。

..。

..。

.。

.。

.。

...。

.。

...。

倒立摆实验报告

倒立摆实验报告

专 业 实 验 报 告 实验名称倒立摆实验 实验时间 姓名 学号一、实验内容1、直线一级倒立摆建模1.1 受力分析针对直线一级倒立摆,在实际的模型建立过程中,可忽略空气流动阻力和其它次要的摩擦阻力,则倒立摆系统抽象成小车和匀质刚性杆组成的系统,如图所示。

图1 小车系统各参数定义:M :小车质量m :摆杆质量β:小车摩擦系数l: 摆杆转动轴心到杆质心的长度I :摆杆惯量F :加在小车上的力X :小车位置Ф:摆杆与垂直向上方向的夹角θ:摆杆与垂直向下方向的夹角摆杆受力和力矩分析图2 摆杆系统摆杆水平方向受力为:H摆杆竖直方向受力为:V由摆杆力矩平衡得方程:cos sin Hl Vl I φφθθπφθφ⎧-=⎪=-⎨⎪=-⎩&&&&&& (1) 代入V 、H ,得到摆杆运动方程。

当0φ→时,cos 1θ=,sin φθ=-,线性化运动方程:1.2 传递函数模型以小车加速度为输入、摆杆角度为输出,令,进行拉普拉斯变换得到传递函数:22()()mlG sml I s mgl=+-(2)倒立摆系统参数值:M=1.096 % 小车质量,kgm=0.109 % 摆杆质量,kg0.1β=% 小车摩擦系数g=9.8 % 重力加速度,l=0.25 % 摆杆转动轴心到杆质心的长度,mI= 0.0034 % 摆杆转动惯量,以小车加速度为输入、摆杆角度为输出时,倒立摆系统的传递函数模型为:20.02725()0.01021250.26705G ss=-(3)1.3 倒立摆系统状态空间模型以小车加速度为输入,摆杆角度、小车位移为输出,选取状态变量:(,,,)x x xθθ=&&(4)由2()I ml mgl mlxθθ+-=&&&&得出状态空间模型01001000000013300044xxxxxgglμθθθθ⎡⎤⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥'==+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎢⎥⎢⎥⎣⎦⎣⎦&&&&&&&&(5)μθθθ'⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=11&&xxxy(6)由倒立摆的参数计算出其状态空间模型表达式:(7)111()()n n n n f s sI A BK s a s a s a --=--=++++L (11)设期望特征根为***12,,,n λλλL ,则期望特征多项式为:***1111()()()n n n n n f x s s s b s b s b λλ--=--=++++L L (12)由*()()f s f s =求得矩阵K 。

哈工大控制系统设计大作业——直线一级倒立摆控制器设计(DOC)

哈工大控制系统设计大作业——直线一级倒立摆控制器设计(DOC)

H a r b i n I n s t i t u t e o f T e c h n o l o g y课程设计说明书(论文)课程名称:控制系统设计课程设计设计题目:直线一级倒立摆控制器设计院系:航天学院控制科学与工程系班级:设计者:学号:指导教师:罗晶设计时间:2012.8.27——2012.9.9哈尔滨工业大学教务处哈尔滨工业大学课程设计任务书*注:此任务书由课程设计指导教师填写。

一、 直线一级倒立摆数学模型的推导及建立系统建模可以分为两种:机理建模和实验建模。

实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号,激励研究对象并通过传感器检测其可观测的输出,应用数学手段建立起系统的输入-输出关系。

这里面包括输入信号的设计选取,输出信号的精确检测,数学算法的研究等等内容。

机理建模就是在了解研究对象的运动规律基础上,通过物理、化学的知识和数学手段建立起系统内部的输入-状态关系。

对于倒立摆系统,由于其本身是自不稳定的系统,实验建模存在一定的困难。

但是经过小心的假设忽略掉一些次要的因素后,倒立摆系统就是一个典型的运动的刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。

下面我们采用其中的牛顿-欧拉方法建立直线型一级倒立摆系统的数学模型。

1.1、微分方程的推导在忽略了空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统. 下图是系统中小车和摆杆的受力分析图。

其中,N 和P 为小车与摆杆水平和垂直方向的分量。

b px图1(a )小车隔离受力图 (b )摆杆隔离受力图 本系统相关参数定义如下:M : 小车质量 m :摆杆质量b :小车摩擦系数 l :摆杆转动轴心到杆质心的长度 I :摆杆惯量 F :加在小车上的力x :小车位置 φ:摆杆与垂直向上方向的夹角θ:摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)注意:在实际倒立摆系统中检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示,图示方向为矢量正方向。

倒立摆实验报告

倒立摆实验报告

倒立摆实验报告机自82组员:李宗泽李航刘凯付荣倒立摆与自动控制原理实验一. 实验目得:1、运用经典控制理论控制直线一级倒立摆,包括实际系统模型得建立、根轨迹分析与控制器设计、频率响应分析、PID 控制分析等内容、2、运用现代控制理论中得线性最优控制LQR方法实验控制倒立摆3、学习运用模糊控制理论控制倒立摆系统4、学习MATLAB工具软件在控制工程中得应用5、掌握对实际系统进行建模得方法,熟悉利用MATLAB 对系统模型进行仿真,利用学习得控制理论对系统进行控制器得设计,并对系统进行实际控制实验,对实验结果进行观察与分析,非常直观得感受控制器得控制作用。

二、实验设备计算机及MATLAB、VC等相关软件固高倒立摆系统得软件固高一级直线倒立摆系统,包括运动卡与倒立摆实物倒立摆相关安装工具三.倒立摆系统介绍倒立摆就是机器人技术、控制理论、计算机控制等多个领域、多种技术得有机结合,其被控系统本身又就是一个绝对不稳定、高阶次、多变量、强耦合得非线性系统,可以作为一个典型得控制对象对其进行研究。

倒立摆系统作为控制理论研究中得一种比较理想得实验手段,为自动控制理论得教学、实验与科研构建一个良好得实验平台,以用来检验某种控制理论或方法得典型方案,促进了控制系统新理论、新思想得发展。

由于控制理论得广泛应用,由此系统研究产生得方法与技术将在半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截控制系统、航空对接控制技术、火箭发射中得垂直度控制、卫星飞行中得姿态控制与一般工业应用等方面具有广阔得利用开发前景.倒立摆已经由原来得直线一级倒立摆扩展出很多种类,典型得有直线倒立摆环形倒立摆,平面倒立摆与复合倒立摆等,本次实验采用得就是直线一级倒立摆。

倒立摆得形式与结构各异,但所有得倒立摆都具有以下得特性: 1)非线性2)不确定性3) 耦合性4) 开环不稳定性5)约束限制倒立摆控制器得设计就是倒立摆系统得核心内容,因为倒立摆就是一个绝对不稳定得系统,为使其保持稳定并且可以承受一定得干扰,需要给系统设计控制器,本小组采用得控制方法有:PID控制、双PID控制、LQR控制、模糊PID控制、纯模糊控制四.直线一级倒立摆得物理模型:系统建模可以分为两种:机理建模与实验建模。

直线一级倒立摆创新实践

直线一级倒立摆创新实践

直线一级倒立摆创新实践学院:班级:姓名:学号:指导老师:目录一、倒立摆系统的介绍......................................................... - 3 -1、倒立摆系统简介........................................................ - 3 -2、倒立摆分类............................................................ - 3 -二、倒立摆系统建模过程....................................................... - 5 -三、交流伺服电机、编码器的工作原理........................................... - 7 -1、交流伺服电机工作原理.................................................. - 7 -2. 编码器工作原理........................................................ - 8 -四、倒立摆系统控制器的设计过程............................................... - 9 -1、控制器设计要求........................................................ - 9 -2、控制器设计方法...................................................... - 10 -3、建立系统模型........................................................ - 10 -5、 MATLAB仿真图....................................................... - 21 -五、心得体会................................................................ - 22 -一、倒立摆系统的介绍1、倒立摆系统简介倒立摆控制系统是一个复杂的、不稳定的、非线性系统,是进行控制理论教学及开展各种控制实验的理想实验平台。

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

电气控制系统设计——直线一级倒立摆控制系统设计学院轮机工程学院班级电气1111姓名李杰学号 36姓名韩学建学号 35成绩指导老师肖龙海2014 年 12 月 25 日小组成员与分工:韩学建主要任务:二阶系统建模与性能分析,二阶控制器的设计,二阶系统的数字仿真与调试,二阶系统的实物仿真与调试;二阶状态观测器的数字仿真与调试,二阶状态观测器的实物仿真与调试;李杰主要任务:四阶系统建模与性能分析,四阶控制器的设计,四阶系统的数字仿真与调试,四阶系统的实物仿真与调试;四阶状态观测器的数字仿真与调试,四阶状态观测器的实物仿真与调试;前言倒立摆系统是非线性、强耦合、多变量和自然不稳定的系统,倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究;倒立摆系统作为控制理论研究中的一种比较理想的实验手段,为自动控制理论的教学、实验和科研构建一个良好的实验平台,以用来检验某种控制理论或方法的典型方案,促进了控制系统新理论、新思想的发展;本报告通过设计二阶、四阶两种倒立摆控制器来加深对实际系统进行建模方法的了解和掌握随动控制系统设计的一般步骤及方法;熟悉倒立摆系统的组成及基本结构并利用MATLAB对系统模型进行仿真,利用学习的控制理论对系统进行控制器的设计,并对系统进行实际控制实验,对实验结果进行观察和分析,研究调节器参数对系统动态性能的影响,非常直观的了解控制器的控制作用;目录第一章设计的目的、任务及要求倒立摆系统的基本结构 (4)设计的目的 (4)设计的基本任务 (4)设计的要求 (4)设计的步骤 (5)第二章一级倒立摆建模及性能分析微分方程的推导 (5)系统的稳定性和能控能观性分析 (11)二阶的能观性、能控性分析 (13)四阶的能观性、能控性分析 (18)第三章倒立摆系统二阶控制器、状态观测器的设计与调试设计的要求 (22)极点配置 (22)控制器仿真设计与调试 (23)状态观测器仿真设计与调试 (28)第四章倒立摆系统四阶控制器、状态观测器的设计与调试设计的要求 (26)极点配置 (26)控制器仿真设计与调试 (27)状态观测器仿真设计与调试 (28)心得体会 (31)参考文献 (31)第一章设计的目的、任务及要求倒立摆系统的基本结构与工作原理图倒立摆系统硬件框图图倒立摆系统工作原理框图倒立摆系统通过计算机、I/O卡、伺服系统、倒立摆本体和光电码盘反馈测量元件组成一个闭环系统;以直线一级倒立摆为例,其工作原理框图如图所示;图中光电码盘1由伺服电机自带,小车的位移可以根据该码盘的反馈通过换算获得,速度信号可以通过对位移的差分得到;各个摆杆的角度由光电码盘2测量并直接反馈到I/O卡,而角速度信号可以通过对角度的差分得到;计算机从I/O卡实时读取数据,确定控制决策电机的输出力矩,并发给I/O卡;I/O卡经过电控箱内部电路产生相应的控制量,驱动电机转动,使小车按控制要求进行运动,以达到控制目的;实验过程中需要了解倒立摆装置基本结构;了解编码盘、行程开关等的基本工作原理;进行行程开关、编码盘和电机基本测试;设计的目的本设计要求我们针对设计要求,利用课堂所学知识及实验室实测来的系统数据采用工程设计法进行一级直线倒立摆控制系统设计;绘制原理图,同时在实验室进行实验检验设计结果,分析数据,编写设计报告;目的是使学生掌握随动控制系统设计的一般步骤及方法;设计的基本任务本课程设计的被控对象采用固高科技生产的GLIP2001一级直线倒立摆;通过设计与调试使学生能够:1熟悉倒立摆系统的组成及其基本结构;2掌握通过解析法建立系统数学模型及进行工作点附近线性化的方法;3掌握系统性能的计算机辅助分析;4掌握系统控制器的设计与仿真;5研究调节器参数对系统动态性能的影响;设计的要求1.熟悉倒立摆系统结构,熟悉倒立摆装置的基本使用方法;2.建立系统的数学模型,并在工作点附近线性化;3.分析系统的稳定性、频域性能、能控性与能观性;4.采用状态空间的极点配置法设计控制器,要求系统调节时间ts<=3s,阻尼比ξ>= and ξ<=1;实验步骤1.倒立摆系统基本结构分析2.对象的建模3..系统性能分析4.控制器设计与调试5.设计报告的撰写第二章一级倒立摆建模及性能分析系统建模可以分为两种:机理建模和实验建模;实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号,激励研究对象并通过传感器检测其可观测的输出, 应用数学手段建立起系统的输入-输出关系;这里面包括输入信号的设计选取,输出信号的精确检测,数学算法的研究等等内容;机理建模就是在了解研究对象的运动规律基础上,通过物理、化学的知识和数学手段建立起系统内部的输入-状态关系;对于倒立摆系统,由于其本身是自不稳定的系统,实验建模存在一定的困难;但是忽略掉一些次要的因素后,倒立摆系统就是一个典型的运动的刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程;下面采用牛顿-欧拉方法建立直线型一级倒立摆系统的数学模型;微分方程的推导在忽略了空气阻力和各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如图所示;我们不妨做以下假设:M 小车质量m 摆杆质量b 小车摩擦系数l 摆杆转动轴心到杆质心的长度I 摆杆惯量 F 加在小车上的力x 小车位置φ摆杆与垂直向上方向的夹角θ摆杆与垂直向下方向的夹角考虑到摆杆初始位置为竖直向下图是系统中小车和摆杆的受力分析图;其中,N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量;注意:在实际倒立摆系统中检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示,图示方向为矢量正方向;分析小车水平方向所受的合力,可以得到以下方程:①由摆杆水平方向的受力进行分析可以得到下面等式:②即:③把这个等式代入①式中,就得到系统的第一个运动方程④为了推出系统的第二个运动方程,对摆杆垂直方向上的合力进行分析,可以得到下面方程:⑤⑥力矩平衡方程如下:⑦注意:此方程中力矩的方向,由于θ= π+φ,cosφ= -cosθ,sinφ= -sinθ,故等式前面有负号; 合并这两个方程,约去P 和N ,得到第二个运动方程:⑧设θ=π+φφ是摆杆与垂直向上方向之间的夹角,假设φ与1单位是弧度相比很小,即φ<<1,则可以进行近似处理:用u 来代表被控对象的输入力F ,线性化后两个运动方程如下:⑨对式3-9进行拉普拉斯变换,得到⑩注意:推导传递函数时假设初始条件为0;由于输出为角度φ,求解方程组的第一个方程,可以得到:⑾⑿如果令则有⒀把上式代入方程组的第二个方程,得到:⒁整理后得到传递函数:⒂其中,该系统状态空间方程为:⒃方程组对解代数方程,得到解如下:⒄整理后得到系统状态空间方程:⒅由9的第一个方程为对于质量均匀分布的摆杆有:于是可以得到:化简得到:⒆⒇以小车加速度为输入的系统状态空间方程:稳定性分析P=polyA;r=rootsP;ii=findrealr>0;n=lengthii;ifn>0disp'不稳定';elsedisp'稳定';end不稳定由此得到系统在未加控制器之前是发散的,不稳定的能控能观性分析A= 0 1 0 0;0 0 0 0;0 0 0 1;0 0 0;B= 0 1 0 3';C= 1 0 0 0;0 0 1 0;D= 0 0 ';>> n=4;Uc=ctrbA,B;Vo=obsvA,C;>> ifrankUc==nifrankVo==ndisp'系统状态即能控又能观'else disp'系统状态即能控,但不能观'endelse ifrankVo==ndisp'系统状态能观,但不能控'else disp'系统状态不能控,但也不能观' endend系统状态即能控又能观二阶的能观性、能控性分析>> A=0 1; 0;>> B=0 3';>> C=0 0 ;1 0;>> D=0;二阶能控性分析:>> M=ctrbA,BM =0 33 0>> rankMans =2说明系统是能控的二阶能观性分析:>> N=obsvA,CN =0 11 0>> rankNans =2说明系统是能观的四阶的能观性、能控性>> A=0 1 0 0; 0 0 0 0;0 0 0 1;0 0 0;;>> B=0 1 0 3';>> C= 1 0 0 0;0 0 1 0;>> D=0 0';四阶能控性分析:>> M=ctrbA,BM =0 0 00 0 00 00 0>> rankMans =4说明系统是能控的四阶能观性分析:>> N=obsvA,CN =0 0 00 0 00 0 00 0 00 0 0 00 0 00 0 0 00 0 0>> rankNans =4说明系统是能观的第三章倒立摆系统二阶控制器的设计设计的要求建立以X’’为输入,Φ与Φ’为状态变量,y为输出的模型分析系统的稳定性,能控能观性设计状态反馈控制器进行极点配置,是系统ξ>= ts<=3s极点配置取ξ=,Ts=;则Wn=,极点为±利用MATLAB进行计算:clear;T=input'T=';zeta=input'zeta=';Wn=4/Tzeta;A=0 1; 0;B=0;3;S1=-zetaWn-Wnsqrtzeta^2-1;S2=-zetaWn+Wnsqrtzeta^2-1;P=S1,S2;K=placeA,B,P则:K0=,K1=;控制器的仿真测试与调试图二阶系统结构图以小车加速度为输入,摆杆偏移角度和角速度为状态变量的模型,K值为反馈矩阵,输出为角度的波形图仿真波形图:取 &= 极点为:Wn=则 K0= K1= 图仿真结果波形图有次图可得加入控制器之后系统可以稳定,可见控制器的设计是合理的硬件调试硬件调试结构图以小车加速度为输入,摆杆偏移角度和角速度为状态变量的模型,加入Л模块纠正反馈角度符号通过调试K值,当K取的时候,可使仿真结果较稳定;从摆杆的角度可以看出,角度可以稳定下来,施加一干扰后,摆杆可以很快恢复稳定;状态观测器的仿真测试与调试图二阶状态观测器数字仿真图以小车加速度为输入,摆杆偏移角度和角速度为状态变量的模型,K值为反馈矩阵,输出为角度的波形图仿真波形图:取 &= 极点为:Wn=则 K0= K1= 图仿真结果波形图反馈矩阵G的求法T=input'T=';zeta=input'zeta=';Wn=4/Tzeta;A=0 1; 0;B=0;3;C=1 0;S1=-zetaWn-Wnsqrtzeta^2-1;S2=-zetaWn+Wnsqrtzeta^2-1;P=S1,S2;OP=5P;G=placeA',C',OPG=实物调试由图可知,施加扰动后摆杆能很快恢复,符合系统要求;第四章倒立摆系统四阶控制器的设计设计要求根据设计要求,确定系统闭环极点,设计状态反馈控制器,并进行仿真、调试验证;极点配置取 &= T= Wn= 极点为:±;-20±利用MATLAB进行计算:T=input'T=';zeta=input'zeta=';Wn=4/Tzeta;A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 0;B=0;1;0;3;S1=-zetaWn-Wnsqrtzeta^2-1;S2=-zetaWn+Wnsqrtzeta^2-1;P=,-20+,S1,S2;K=placeA,B,Pk0=,k1=,k2= ,k3=;则K=控制器的仿真测试与调试图四阶系统仿真结构图以小车加速度为输入,摆杆角度、角速度、小车位移、加速度为状态变量,上半部分为位移输出,下半部分为角度输出仿真结果:位移:角度:实物调试:图硬件调试结构图将K1、K2、K3、K4合并后反馈作用系统,系统为单输入双输出四阶一级倒立摆状态空间极点配置实时控制结果平衡时上为位移,下位角度直线一级倒立摆状态空间极点配置实时控制结果施加干扰上为位移,下位角度状态观测器仿真设计与调试图四阶状态观测器数字仿真图四阶系统仿真结构图以小车加速度为输入,摆杆角度、角速度、小车位移、加速度为状态变量,上半部分为位移输出,下半部分为角度输出反馈矩阵G的求法T=input'T=';zeta=input'zeta=';Wn=4/Tzeta;A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 0;B=0;1;0;3;C=1 0 0 0;0 0 1 0;S1=-zetaWn-Wnsqrtzeta^2-1;S2=-zetaWn+Wnsqrtzeta^2-1;P=,-10+,S1,S2;OP=3P;G=placeA',C',OP'G =实物调试反馈矩阵G和增益矩阵K分别调用matlab程序即可实物仿真与结果心得体会通过此次课程设计,使我更加扎实的掌握了有关MATLAB方面的知识,在设计过程中虽然遇到了一些问题,但经过一次又一次的思考,一遍又一遍的检查终于找出了原因所在,也暴露出了前期我在这方面的知识欠缺和经验不足;实践出真知,通过亲自动手制作,使我们掌握的知识不再是纸上谈兵;课程设计诚然是一门专业课,给我很多专业知识以及专业技能上的提升,同时又是一门讲道课,一门辩思课,给了我许多道,给了我很多思,给了我莫大的空间;同时,设计让我感触很深;使我对抽象的理论有了具体的认识;通过这次课程设计,我掌握了倒立摆装置的识别和测试;熟悉了控制系统的设计原理;了解了现代控制理论的设计方法;以及如何提高倒立摆系统的性能等等,掌握了MATLAB、simulink的使用方法和技术,通过查询资料,对所学知识有了很多新的认识;自己写主要参考文献:1.夏德玲、翁贻方,自动控制理论.北京,北京工业大学出版社,2006年1月2.刘豹、唐万生,现代控制理论.北京,机械工业出版社,2006年6月3.李国勇、谢克明,计算机仿真技术与CAD.北京,电子工业出版社,2009年1月4.Googol Technology直线倒立摆系统GLIP系列安装与使用手册固高科技。

相关文档
最新文档