一阶倒立摆系统模型分析、状态反馈与观测器设计PPT精选文档_第1页
一阶倒立摆系统模型分析、状态反馈与观测器设计PPT精选文档_第2页
一阶倒立摆系统模型分析、状态反馈与观测器设计PPT精选文档_第3页
一阶倒立摆系统模型分析、状态反馈与观测器设计PPT精选文档_第4页
一阶倒立摆系统模型分析、状态反馈与观测器设计PPT精选文档_第5页
已阅读5页,还剩30页未读 继续免费阅读

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

1、1一阶倒立摆系统模型分析、状态反馈与观测器设计21.建立一级倒立摆数学模型 图1.一级倒立摆模型 注意:后面建立倒立摆数学模型过程中忽略了空气阻力和弹性形变等。 3 首先对摆杆进行受力分析,如图2所示。其中H表示摆杆受到的水平方向力,N表示摆杆所受的竖直方向的力,摆杆所受的旋转摩擦力矩用 表示,则得到摆杆平面运动微分方程。 图2.摆杆受力分析图c4 (1)水平方向: 摆杆质心的水平位移 摆杆受到的水平方向力 (2)竖直方向 摆杆质心的竖直位移: 摆杆受到的竖直方向力 (3)绕质心的转动 sinlxxc)sincos(2llxmxmHc coslyc)cossin(-2llmymmgNc 0si

2、ncos-JcNlHl5 根据以上方程可得 消去H和N可得 由 则得 022sincoscossinsincosJcNlHlmlmlmgNmlmlxmH cmglmlJxmlsin)()cos(2020mlJJ cmglJxmlsin)cos(6 根据系统最终的控制方式,给系统施加的控制量是车体的加速度,因此选择加速度为系统的输入,从而可得倒立摆系统的运动学方程: 根据以上系统方程可以看出倒立摆模型是非线性的。为了应用线性系统理论,可在倒立摆平衡位置附近对系统进行线性化,取 ,令 并忽略高次项,可得如下方程: cossinuJmlJcJmglux -1cos,sinuJmlJcJmglux 7

3、 可以用线性系统理论对倒立摆系统进行控制,选择状态变量x。 则状态空间表达式可表示为: xxxxxx4321uJmlxxxxJcJmglxxxx/010/00100000000010432143218 倒立摆系统参数如下9 代入数据计算得状态空间表达式:uxxxxxxxx9747. 50106747. 06118.58001000000000104321432143213101000001xxxxxxy102.倒立摆数学模型分析 (1)稳定性分析 根据特征方程的根来判断系统的稳定性, 由 计算得特征根为 知系统是不稳定的。06118.586747. 06747. 06118.580010000

4、000122sssssssAsI0006. 8,3259. 7, 04321ssss11 (2)可控性分析 由 知系统是完全能控的,满足特征值可任意配置的极点配置定理。nrankBABAABBrank43786.4749077.3520311. 49747. 59077.3520311. 49747. 5000010103212 (3)可观测性分析 由 可知系统完全能观,满足全维观测器极点配置条件。4067.595454.390000006747. 06118.58000000100000100100000132rankCACACACrank133.状态反馈 对于系统的状态方程 状态反馈的基本

5、结构为: K为状态反馈增益阵。DuCxyBuAxx 14 状态反馈闭环系统的状态空间表达式为: 状态反馈实际上是通过状态反馈增益阵K的选择来改变闭环系统的特征值,从而获得系统所要求的性能。反之,可以根据系统所要求的性能来确定闭环系统的特征值,进而确定K的值(对应于极点配置的内容)。DvxDKCyBvxBKAx 154.极点配置假设系统要求超调量不超过10%,调整时间为2s,根据公式 经计算取 , 可得系统特征方程为 主导极点为%10)1/(2e7 . 024nswt3nw092 . 42222sswswsnn1424. 21 . 22, 1js16 对于倒立摆系统,选取其余n-2=2个期望的闭

6、环极点(选取的闭环极点应远离主导极点)。则取为 因此得期望的闭环特征多项式为: 104, 3s 9006001932 .24)1424. 21 . 2)(1424. 21 . 2(10)()(23424321ssssjsjsssssssssssa17 对于原被控系统 ,引入 反馈后闭环系统 特征多项式为 比较 可求得CBA ,4321kkkkK CBBKA,121212332446118.58-)s6118.586747. 0()6747. 09747. 56118.58()9747. 56747. 0()(det)(kkkskkkskksBKAsIsp sasp)(9006118.58-60

7、06118.586747. 01936747. 09747. 56118.582 .249747. 56747. 012112324kkkkkkkk18 解得 则反馈增益阵为 状态反馈通过调整K能任意配置闭环系统的极点,有效地改善系统的性能。同时,系统解耦、镇定、渐近跟踪以及最优控制等都离不开状态反馈。但状态反馈的前提条件是必须得到系统内部的各个状态变量,而系统的状态变量往往比较难获取,甚至是无法测量,因此需要设计状态观测器来重构系统的状态。6804. 5,8588.45,4136.10,3551.154321kkkk5.6804 45.8588 10.4136- 15.3551- K194.

8、状态观测器设计 状态观测器的定义: 设系统 的状态x不能直接检测,构造一个动态系统 ,以 的输入u和输出y为输入量,能产生一组输出量 渐进与x,使 则称 为 的状态观测器。CBA,CBA,x 0limxxtCBA ,20 状态观测器的方程为: 虚线框为状态观测器,状态逼近的速度取决于G的选择和A-GC的配置。BuGyxGCAyyGBuxAx) (21 倒立摆系统状态观测器的设计: 根据观测器综合原则,可取期望的观测器特征值为-20,-20, , 采用极点配置算法可计算得观测器增益矩阵G为 计算32-5 j325jTG4343.2119079.275615.78-9281. 3-1830.122

9、3224. 63480.284174.216747. 08225.15201830.12219079.2703224. 605615.7803480.2809281. 314174.21GCA22 带状态观测器的状态反馈系统为235.仿真分析 基于全维状态观测器下的倒立摆控制系统仿真:24 仿真结果25 状态估计值与系统状态比较 从仿真结果看,控制性能满足系统要求的性能指标。26 全维观测器状态跟踪误差仿真结果:27降维观测器设计 在实际工程实践中,系统的输出是能够测量的,因此可以考虑用输出量直接产生响应的部分状态变量,其余状态变量则通过构造观测器来实现,所构造的观测器为降维观测器。本实验的倒

10、立摆系统采用P变换方法设计降维观测器。28 (1)由rank(C)=2,对于C取如下非奇异阵P 则 (2)取期望的特征值为 ,则特征多项式为 ,解方程 得1000001001000001P2221121116747. 0-06118.580000010000100AAAAPAPA9747. 510021BBPBB阵。为、阵为和阵,均为、其中24,1222212122211211QQBBAAAA30,30 3710)(2sssa)()det(1222saKAAsITT3253.290030K2111000001001000001QQPQ29 进一步计算 综合得到降维状态观测器为3253.2900

11、30TKL300030-1222ALA6118.58000-1121ALA9747. 51-12BLB221212112121222)-()-()-(xQyQxyLzxuBLByALAxALAz 30 基于降维观测器的倒立摆控制系统仿真:31 基于降维状态观测器的倒立摆控制系统仿真 从仿真结果看,控制性能也满足系统要求。32 降维观测器状态跟踪误差仿真结果:33 不管是系统的极点配置、镇定、解耦控制、无静差跟踪还是线性二次型的最优控制,都可以用状态反馈去加以实现。但是状态不易直接量测,或者是由于量测的设备在经济上和使用上的限制,使得不可能来实际获得系统的全部状态变量,从而使状态反馈的物理实现成为不可能。状态反馈在性能上的不可替代性和在物理上的不能实现性形成了一个尖锐的矛盾。解决这个矛盾的途径之一,就是通过重构系统的状态,并用这个重构的状态来代替系统的真实状态,以实现所要求的状态反馈。状态观测器正是在这样的背景下提出的一个同时具有理论意义和应用价值的研究课题。34 对线性系统而言,著名的Kalman 滤波器和Luenberger 观测器为该领域的观测器设计问题提供了较为完美的答案(对非线性系统而言,

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论