一级倒立摆MATLAB仿真、能控能观性分析、数学模型、极点配置
- 格式:doc
- 大小:472.00 KB
- 文档页数:8
第1 页共11 页倒立摆系统的建模及Matlab仿真1.系统的物理模型考虑如图(1)所示的倒立摆系统。
图中,倒立摆安装在一个小车上。
这里仅考虑倒立摆在图面内运动的二维问题。
图(1)倒立摆系统假定倒立摆系统的参数如下。
摆杆的质量:m=0.1gl=1m小车的质量:摆杆的长度:2重力加速度:g=9.8m/M=1kg s摆杆的质量在摆杆的中心。
设计一个控制系统,使得当给定任意初始条件(由干扰引起)时,最大超调量?≤10%,调节时间ts ≤4s ,通过小车的水平运动使倒立摆保持在垂直位置。
2.系统的数学模型2.1建立倒置摆的运动方程并将其线性化。
为简化问题,在数学模型中首先假设:1)摆杆为刚体;2)忽略摆杆与支点之间的摩擦;3)忽略小车与接触面间的摩擦。
?),在u设小车瞬时位置为z,摆心瞬时位置为(作用下,小车及摆均产生加速远动,sin?lz根据牛顿第二定律,在水平直线远动方向的惯性力应与u平衡,于是有22dzd?)?sinu?M?m(zl22dtdt???2????z(M?mml?)cos?mlusin?即:??①绕摆轴转动的惯性力矩与重力矩平衡,因而有.第2 页共11 页2??d??? sin??lcosm(z?lsinmgl)??2dt?????22???????即:nis?l?ocgcosincoszs?ls??②以上两个方程都是非线性方程,为求得解析解,需作线性化处理。
由于控制的目的是保持倒立摆直?2?????且可忽略则,立,在试驾合适的外力条件下,假定θ很小,接近于零时合理的,1sincos??,项。
于是有???M?zm?u?ml??)(③????g?z?l??④联立求解可得1mg?u?z????MM 1)?m(M????u??MlMl 列写系统的状态空间表达式。
2.2??T xx,x,x,,选取系统变量则xx,x,xx?,42134123xx??211mgux???x?32MM x?x?431)(M?mu?x?x?34MlMl 即00100????z??1mg??????000?z?????dMM??Bu?Ax?xux????????00001???dt????1gm?(M)????000???????MlMl??????Cx?0?y?xx1001代入数据计算得到:0100????000?1??????T0D,?0??1BA?,?001,C100??1000??00011??11 页3 页共第3.设计控制器3.1判断系统的能控性和稳定性1100????0011????23BBAABAB?Q?故被控对象完全可控,rank()=4,Q kk??11?0?10??011?10???22???11?。
基于Matlab的一级倒立摆模型的仿真一.倒立摆模型的研究意义倒立摆控制系统是一个复杂的、不稳定的、非线性系统,是进行控制理论教学及开展各种控制实验的理想的实验平台。
对倒立摆系统的研究能有效的反应控制中的典型问题:如非线性问题、鲁莽性问题、镇定问题等。
通过对倒立摆的控制,用来检测新的控制方法是否有较强的处理非线性和不稳定性问题的能力。
二.倒立摆模型的数学建模质量为m的小球固结于长度为L的细杆上(细杆质量不计),细杆和质量为M的小车铰链相接分析过程如下:如图所示,设细杆摆沿顺时针方向转东伟正方向,水平向右为水平方向上的正方向。
当细杆白顺时针想要运动时水平方向施加的里应该是水平相应。
对方程组进行拉普拉斯变化,得到摆杆角度和小车位移的传递函数:摆杆角度和小车加速度之间的传递函数:摆杆角度和小车加速度之间的传递函数:位移X对外力F的传递函数:三.在Matlab中输入得到的反馈矩阵:采用MATLAB/Simulink构造单级倒立摆状态反馈控制系统的仿真模型,如下图所示。
首先,在M A T L A B的Command Window中输入各个矩阵的值,并且在模型中的积分器中设置非零初值(这里我们设置为[0 0 0.1 0]。
然后运行仿真程序。
得到的仿真曲线从仿真结果可以看出,可以将倒立摆的杆子与竖直方向的偏角控制在θ=0(即小球和杆子被控制保持在竖直倒立状态),另外说明下黄线代表位移,紫线代表角度。
四.总结由实验中可知,倒立摆系统是一个非线性的较复杂的不稳定系统,故要满足故要满足稳定性要求,就得对系统进行线性化近似和稳定控制。
当然我们调节出来的只是一个理想模型,在实际中会更加复杂,稳定性也会更难获得。
在这次实验中掌握了倒立摆仿真的整个过程,熟悉了MATLAB仿真软件Simulingk的使用,也对系统有了更好的理解。
非线性作业一 一级直线倒立摆如图1所示系统里的各参数变量M :小车系统的等效质量(1.096kg );:摆杆的质量(0.109kg );1m :摆杆的半长(0.25m );2m J :摆杆系统的转动惯量(0.0034kg*m );g :重力加速度(9.8N/Kg );r :小车的水平位置(m );θ:摆角大小(以竖直向上为0起始位置,逆时针方向为正方向);:小车对摆杆水平方向作用力(N )(向左为正方向),’是其反作用力;h F h F :小车对摆杆竖直方向作用力(N )(向上为正方向),’是其反作用力;v F v F U :电动机经传动机构给小车的力,可理解为控制作用u’(向左为正方向);:摆杆重心的水平位置(m );:摆杆重心的竖直位置(m )。
p x p y 1.1一级倒立摆的数学建模定义系统的状态为[r,r, θ, θ]经推导整理后可以达到倒立摆系统的牛顿力学模型:(1)θθθsin cos )(2mgl l r m ml I =-+ (2)u ml r m M ml -⋅=+-⋅2sin )(cos θθθθ 因为摆杆一般在工作在竖直向上的小领域内θ=0,可以在小范围近似处理:,则数学模型可以整理成:0,0sin ,1cos 2==≈θθθ (3)θθmgl l r m ml I =-+ )(2 (4)u r m M ml =++- )(θ系统的状态空间模型为=+ (5)⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡θθ r r ⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡+++++0)()(010000)(0000102222Mml m M I m M mgl Mml m M I gl m ⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡θθr r ⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎣⎡+++++222)(0)(0Mml m M I ml Mml m M I ml I u (6)u r r r y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=0000101000θθθ 代人实际系统的参数后状态方程为:=+ (7)⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡θθ r r ⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡08285.2700100006293.0000010⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡θθ r r u ⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡3566.208832.00 (8)u r r r y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=0000101000θθθ 1.2滑模变结构在一级倒立摆系统的应用主要包括切换函数的设计、控制率的设计和系统消除抖振的抑制。
一级倒立摆系统仿真及分析1•摘要本次课程设讣,我们小组选择一级倒立摆系统作为物理模型,首先通过物理分析建立数学模型,得到系统的传递函数,通过对传递函数的极点,根轨迹,单位阶跃响应来分析系统稳定性。
建立状态空间模型,利用matlab进行能控能观性分析, 输入阶跃信号,分析系统输出响应。
通过设定初始条件,查看系统稳定性,利用simulink绘制系统状态图。
再对系统进行极点配置,进行状态反馈,使得系统在初始状态下处于稳定状态,并绘制系统状态图。
2・;3课程设计目的倒立摆系统是一个经典的快速、多变量、非线性、绝对不稳定系统,是用来检验某种控制理论或方法的典型方案。
倒立摆控制理论产生的方法和技术在半导体及精密仪器加E.机器人技术、导弹拦截控制系统和航空器对接控制技术等方面具有广阔的开发利用前景。
因此研究倒立摆系统具有重要的实践意义。
4.课程设计题目描述和要求本次课程设计•我们小组选择环节项H三:系统状态响应、输出响应的测量。
<环节目的:1. 利用MATLAB分析线性定常系统。
2. 利用SIMULINK进行系统状态空间控制模型仿真,求取系统的状态响应及输出响应。
环节内容、方法:1•给定系统状态空间方程,对系统进行可控性、可观性分析。
并利用SIMULINK 绘制系统的状态图,求取给定系统输入信号和初始状态时的状态响应及输出响应。
2.给定两个系统的状态空间模型,分别求两个系统的特征值;将两个系统的系统矩阵化为标准型;求出给定系统初始状态时,状态的零输入响应;求两个系统的传递函数并分析仿真结果。
4.课程设计报告内容数学模型的建立及分析对于倒立摆系统,山于其本身是自不稳定的系统,实验建模存在一定的困难。
但是经过小心的假设忽略掉一些次要的因素后,倒立摆系统就是一个典型的运动的刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。
下面我们采用其中的牛顿一欧拉方法建立直线型一级倒立摆系统的数学模型。
在忽略了空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如下图1所示我们不妨做以下假设:M小车质量、m摆杆质量、b小车摩擦系数、I摆杆转动轴心到杆质心的长度、I摆杆惯、F加在小车上的力、x小车位置、<1)摆杆与垂直向上方向的夹角、0 摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)。
基于MATLAB的一级倒立摆控制系统仿真与设计一级倒立摆是一个经典的控制系统问题,它由一根杆子和一个在杆子顶端平衡的质点组成。
杆子通过一个固定的轴连接到一个电机,电机可以通过施加力来控制杆子的平衡。
设计一个控制系统来实现对一级倒立摆的稳定控制是一个重要的研究课题。
在这篇文章中,我们将介绍基于MATLAB的一级倒立摆控制系统仿真与设计。
我们将首先介绍一级倒立摆的数学模型,并根据模型设计一个反馈控制器。
然后,我们将使用MATLAB来进行仿真,评估控制系统的性能。
一级倒立摆的数学模型可以通过牛顿第二定律得到。
假设杆子是一个质点,其运动方程可以表示为:ml²θ''(t) = mgl sin(θ(t)) - T(t)其中m是质点的质量,l是杆子的长度,g是重力加速度,θ(t)是杆子相对于竖直方向的偏角,T(t)是电机施加的瞬时力。
为了设计一个稳定的控制系统,我们可以使用PID控制器,其控制输入可以表示为:T(t) = Kp(θd(t) - θ(t)) + Ki∫(θd(t) - θ(t))dt +Kd(θd'(t) - θ'(t))其中Kp,Ki和Kd分别是比例,积分和微分增益,θd(t)是我们期望的杆子偏角,θ'(t)是杆子的角速度。
在MATLAB中,我们可以使用Simulink来建模和仿真一级倒立摆的控制系统。
我们可以进行以下步骤来进行仿真:1. 建立一级倒立摆的模型。
在Simulink中,我们可以使用Mass-Spring-Damper模块来建立质点的运动模型,并使用Rotational Motion 库提供的Block来建立杆子的旋转模型。
2. 设计反馈控制器。
我们可以使用PID Controller模块来设计PID 控制器,并调整增益参数以实现系统的稳定性和性能要求。
3. 对控制系统进行仿真。
通过在MATLAB中运行Simulink模型,我们可以观察控制系统的响应,并评估系统的稳定性和性能。
非线性作业一 一级直线倒立摆如图1所示系统里的各参数变量M :小车系统的等效质量(1.096kg );1m :摆杆的质量(0.109kg );2m :摆杆的半长(0.25m );J :摆杆系统的转动惯量(0.0034kg*m );g :重力加速度(9.8N/Kg );r :小车的水平位置(m );θ:摆角大小(以竖直向上为0起始位置,逆时针方向为正方向); h F :小车对摆杆水平方向作用力(N )(向左为正方向),h F ’是其反作用力; v F :小车对摆杆竖直方向作用力(N )(向上为正方向),v F ’是其反作用力; U :电动机经传动机构给小车的力,可理解为控制作用u’(向左为正方向); p x :摆杆重心的水平位置(m );p y :摆杆重心的竖直位置(m )。
1.1一级倒立摆的数学建模定义系统的状态为[r,r, θ, θ]经推导整理后可以达到倒立摆系统的牛顿力学模型:θθθsin cos )(2mgl l r m ml I =-+ (1)u ml r m M ml -⋅=+-⋅2sin )(cos θθθθ (2) 因为摆杆一般在工作在竖直向上的小领域内θ=0,可以在小范围近似处理:0,0sin ,1cos 2==≈θθθ ,则数学模型可以整理成:θθmgl l r m ml I =-+ )(2 (3) u r m M ml =++- )(θ (4) 系统的状态空间模型为⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡θθ r r =⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡+++++0)()(0010000)(0000102222Mml m M I m M mgl Mml m M I gl m ⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡θθ r r +⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎣⎡+++++222)(0)(0Mml m M I ml Mml m M I ml I u (5) u r r r y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=0000101000θθθ (6) 代人实际系统的参数后状态方程为:⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡θθ r r =⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡08285.2700100006293.0000010⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡θθ r r +u ⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡3566.208832.00 (7) u r r r y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=0000101000θθθ (8) 1.2滑模变结构在一级倒立摆系统的应用主要包括切换函数的设计、控制率的设计和系统消除抖振的抑制。
(完整word版)一级倒立摆控制方法比较一级倒立摆控制方法比较摘要:倒立摆系统是一个典型的多变量、非线性、强耦合和快速运动的自然不稳定系统。
针对一级倒立摆系统,首先利用牛顿力学的知识建立了数学模型,然后利用Simulink 及其封装功能建立倒立摆的仿真模型,使模型更具灵活性,给仿真带来很大方便。
根据状态方程判断系统的能控、能观性。
通过LQR控制算法和极点配置设计控制器使系统达到稳定状态,分析两种方法的优缺点, 并利用Matlab仿真加以证实。
关键词:倒立摆; LQR ;极点配置;MatlabDISCUSSION ON CONTROLOF INVERTED PENDULUMAbstract:the inverted pendulum system is a typical multi—variable, nonlinear, strong coupling and rapid movement of the natural unstable system. According to the level of inverted pendulum system,firstI make use of Newtonian mechanics knowledge to establishthe mathematical model,and use the Simulink and packaging function to establish inverted pendulum simulation model。
The model is more flexibility, bringing a lot of convenience for simulation. By the equation of state, controllability and observablityof system can be sure。
《控制系统分析与综合》任务书题目:基于MATLAB的一级倒立摆控制系统仿真分析与设计要求:对给定直线倒立摆系统模型,首先利用matlab对系统进行根轨迹、bode 图或能控性分析,然后根据控制系统设计指标进行相应控制器设计,在matlab 仿真环境下得到控制器参数,再将其写入实际倒立摆控制系统中,观察实际控制效果,进行控制参数的适当调整。
任务:1、超前校正控制器设计设计指标:调整时间t s=0.5s (2%) ;最大超调量δp≤10%设计步骤:先对传递函数模型进行根轨迹分析,讨论原系统的稳定性等,然后利用sisotool设计超前校正控制器,仿真满足设计要求后,再在实际系统中运行测试控制效果,观察分析实际控制现象,进行参数微调。
2、滞后超前校正控制器设计设计指标:系统的静态位置误差常数为10,相位裕量为500,增益裕量等于或大于10 分贝。
设计步骤:先对传递函数模型进行bode图分析,讨论原系统的稳定性等,然后利用sisotool设计滞后超前校正控制器,仿真满足设计要求后,再在实际系统中运行测试控制效果,观察分析实际控制现象,进行参数微调。
3、PID控制设计指标:调整时间t s尽量小;最大超调量δp≤10%设计步骤:先在matlab/simulink下构建PID仿真控制系统,依照PID参数整定原则进行系统校正,仿真满足设计要求后,再在实际系统中运行测试控制效果,观察分析实际控制现象,进行参数微调。
4、状态空间极点配置控制设计指标:要求系统具有较短的调整时间(约3秒)和合适的阻尼(阻尼比ζ= 0.5-0.7)。
设计步骤:先对系统进行能控性分析,然后根据设计要求选择期望极点(考虑主导极点),编程求出反馈矩阵K,进行系统仿真。
仿真满足设计要求后,再在实际系统中运行测试控制效果,观察分析实际控制现象,进行参数微调。
设计报告要求:报告提供如下内容1 封面2 目录3 正文(1)任务书(2)分别对四个设计任务按照系统分析、控制器仿真设计、实际系统运行分析形成报告4 收获、体会5 参考文献格式要求:题目小三,宋体加粗目录、正文、小标题均为小四宋体,其中标题加粗。
MATLAB配置倒立摆系统极点编辑整理:尊敬的读者朋友们:这里是精品文档编辑中心,本文档内容是由我和我的同事精心编辑整理后发布的,发布之前我们对文中内容进行仔细校对,但是难免会有疏漏的地方,但是任然希望(MATLAB配置倒立摆系统极点)的内容能够给您的工作和学习带来便利。
同时也真诚的希望收到您的建议和反馈,这将是我们进步的源泉,前进的动力。
本文可编辑可修改,如果觉得对您有帮助请收藏以便随时查阅,最后祝您生活愉快业绩进步,以下为MATLAB配置倒立摆系统极点的全部内容。
现代控制理论MATLAB计算学院: 电气工程学院专业班级:电气工程及其自动化1403班学生姓名: 王宁学号: 140301308摘要:讨论了采用MATLAB语言编程实现控制系统的空间状态方程模型建立,及离散化,判断能控性,能观性,阶跃响应,实现控制系统极点任意配置。
并以倒立摆系统为实例计算。
关键词:空间状态方程;控制系统;极点配置目录一.绪论3(1)MATLAB及其控制系统工具箱简介3(2)状态反馈极点配置3(3)能控性和能观性3(4)MATLAB编程3二.MATLAB计算5(1)状态空间方程5(2)求解离散化x(t)6(3)阶跃响应6(4)判断能控性能观性7(5)极点配置7(6)结论9三.总结9一.绪论(1)MATLAB及其控制系统工具箱简介MATLAB是一套高性能的数值计算和可视化软件,具有工程计算,算法研究,符号运算,建模和仿真,原形开发,数据分析及可视化,科学和工程绘图,应用程序设计等功能,MATLAB包含了涉及多种学科的众多工具。
其中,控制系统工具箱主要处理以传递函数为主要特征的经典控制和以状态方程为特征的现代控制中的问题,为用户提供了用于处理和分析线性时不变(LTI)模型,它支持连续系统和离散系统,单输入单输出(SISO)系统和多输入多输出(MIMO)系统。
利用该工具箱中的函数不但可以实现系统模型的建立,转换,分析和处理,还可以进行控制系统的设计。
一级直线倒立摆极点配置控制实验一、实验目的1.运用经典控制理论控制直线一级倒立摆,包括实际系统模型的建立、根轨迹分析和控制器设计、PID 控制分析等内容。
2.熟悉利用极点配置方法来进行倒立摆实验的原理方法。
3.学习MATLAB工具软件在控制工程中的应用。
3.掌握对实际系统进行建模的方法,熟悉利用MATLAB 对系统模型进行仿真,利用学习的控制理论对系统进行控制器的设计,并对系统进行实际控制实验,对实验结果进行观察和分析,非常直观的感受控制器的控制作用。
二、实验设备计算机及MATLAB相关软件元创兴倒立摆系统的软件元创兴一级直线倒立摆系统,包括运动卡和倒立摆实物倒立摆相关安装工具三、倒立摆系统介绍倒立摆是进行控制理论研究的典型实验平台。
由于倒立摆系统的控制策略和杂技运动员顶杆平衡表演的技巧有异曲同工之处,极富趣味性,而且许多抽象的控制理论概念如系统稳定性、可控性和系统抗干扰能力等等,都可以通过倒立摆系统实验直观的表现出来。
学习自动控制理论的学生通过倒立摆系统实验来验证所学的控制理论和算法,非常的直观、简便,在轻松的实验中对所学课程加深了理解。
倒立摆不仅仅是一种优秀的教学实验仪器,同时也是进行控制理论研究的理想实验平台。
由于倒立摆系统本身所具有的高阶次、不稳定、多变量、非线性和强耦合特性,许多现代控制理论的研究人员一直将它视为典型的研究对象,不断从中发掘出新的控制策略和控制方法,相关的科研成果在航天科技和机器人学方面获得了广阔的应用。
四、倒立摆工作原理和物理模型以及数学模型(简述)1、工作原理:数据采集卡(也称运动控制卡,安装于计算机机箱的PCI插槽上)采集到旋转编码器数据和电机尾部编码器数据,旋转编码器与摆杆同轴,电机与小车通过皮带连接,所以通过计算就可以得到摆杆的角位移以及小车位移,角位移差分得角速度,位移差分可得速度,然后根据自动控制中的各种理论转化的算法计算出控制量。
控制量由计算机通过运动控制卡下发给伺服驱动器,由驱动器实现对电机控制,电机尾部编码器连接到驱动器形成闭环,从而可以实现闭环控制。
题目一:
考虑如图所示的倒立摆系统。
图中,倒立摆安装在一个小车上。
这里仅考虑倒立摆在图面内运动的二维问题。
倒立摆系统的参数包括:摆杆的质量(摆杆的质量在摆杆中心)、摆杆的长度、小车的质量、摆杆惯量等。
图倒立摆系统
设计一个控制系统,使得当给定任意初始条件(由干扰引起)时,最大超调量 %≤10%,调节时间ts ≤4s ,使摆返回至垂直位置,并使小车返回至参考位置(x=0)。
要求:1、建立倒立摆系统的数学模型
2、分析系统的性能指标——能控性、能观性、稳定性
3、设计状态反馈阵,使闭环极点能够达到期望的极点,这里所说的期望的极点确定
是把系统设计成具有两个主导极点,两个非主导极点,这样就可以用二阶系统的
分析方法进行参数的确定
4、用MATLAB 进行程序设计,得到设计后系统的脉冲响应、阶跃响应,绘出相应状
态变量的时间响应图。
解:
1 建立一级倒立摆系统的数学模型
1.1 系统的物理模型
如图1所示,在惯性参考系下,设小车的质量为M ,摆杆的质量为m ,摆杆长度为l,在某一瞬间时刻摆角(即摆杆与竖直线的夹角)为θ,作用在小车上的水平控制力为u。
这样,整个倒立摆系统就受到重力,水平控制力和摩擦力的3外力的共同作用。
图1 一级倒立摆物理模型
1.2 建立系统状态空间表达式
为简单起见,本文首先假设:(1)摆杆为刚体 ;(2)忽略摆杆与支点之间的摩擦;( 3) 忽略小车与导轨之间的摩擦。
在如图一所示的坐标下,小车的水平位置是y,摆杆的偏离位置的角度是θ,摆球的水平位置为y+lsin θ。
这样,作为整个倒立摆系统来说,在说平方方向上,根据牛顿第二定律,得到
u l y dt
d m dt d M =++)sin (y 22
22θ (1)
对于摆球来说,在垂直于摆杆方向,由牛顿第二运动定律,得到
θθsin )sin y (m 22
mg l dt
d =+ (2)
方程(1),(2)是非线性方程,由于控制的目的是保持倒立摆直立,在施加合适的外力条件下,假定θ很小,接近于零是合理的。
则sin θ≈θ,cos θ≈1。
在以上假设条件下,对方程线性化处理后,得倒
u ml M =++..
..y m θ)( (3)
θ
θmg l m =+..
..m y (4)
对于(3)(4)两个式子联立求解,得到
u M
1
M mg -y ..
+=θ (5)
u Ml
g M 1M m θ..
-+=θ)( (6)
如果选择位移y 、速度.
y 、角度θ和角速度.
θ为系统的状态变量,位移y 为系统的输出,控制力u 为输入量,并令x 1=y,.
.
12x y x ==,θx 3=,.
.34θx ==x ,则得到 系统的状态表达式为:
u
1010000100000000
1
4321.4.3
.2.1⎥⎥
⎥⎥⎥⎦
⎤⎢⎢⎢⎢
⎢⎣⎡-+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢
⎢⎢⎣
⎡+-=⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡Ml M x x x x g
Ml m M g
M
m
x x x x )( (7-a )
][⎥⎥⎥
⎥
⎦
⎤
⎢⎢⎢⎢⎣⎡=43210001y x x x x (7-b )
2 分析系统的性能指标——能控性、能观测性、稳定性
设系统的参数为M=1kg,m=0.1kg,l=1m,重力加速度g=9.81m/s 2
,于是
1981.0mg ≈=M
1179.10l
m)g
≈=+M M (
11
=M
1l
1
=M 故
u
101001100
1000010000104321.4.3.2.1⎥
⎥⎥⎥⎦
⎤
⎢⎢⎢⎢⎣⎡-+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡-=⎥⎥⎥⎥⎥⎥⎦
⎤⎢⎢⎢⎢⎢⎢⎣⎡x x x x x x x x (8-a )
][⎥⎥⎥
⎥
⎦
⎤⎢⎢⎢⎢⎣⎡=43210001y x x x x (8-b )
故而有:
A=[0 1 0 0;0 0 -1 0;0 0 0 1;0 0 11 0]; B=[0;1;0;-1]; C=[1 0 0 0]; 2.1 能控性
在MA TLAB 中,输入
A=[0 1 0 0;0 0 -1 0;0 0 0 1;0 0 11 0]; B=[0;1;0;-1]; C=[1 0 0 0];
Qc=[B A*B A*A*B A*A*A*B] 得到 Qc =
0 1 0 1 1 0 1 0 0 -1 0 -11
-1 0 -11 0 再输入 rank(Qc),得到 ans = 4
于是系统是能控的。
2.2 能观测性
在MA TLAB 中,输入
A=[0 1 0 0;0 0 -1 0;0 0 0 1;0 0 11 0]; B=[0;1;0;-1]; C=[1 0 0 0];
Q0=[C;C*A;C*A*A;C*A*A*A];
得到
Q0 =
1 0 0 0
0 1 0 0
0 0 -1 0
0 0 0 -1
再输入rank(Q0)
ans =
4
于是系统是能观测的。
2.3稳定性
计算det[λI-A]=0;
求得的结果是λ1=0;λ2=0;λ3=11;λ4=-11。
因为结果不全是负实部,故而该系统不稳定。
3 状态反馈系统的极点配置以及求状态反馈阵
3.1 状态反馈阵极点配置
因为我们知道,该系统的能控性矩阵满秩,所以该系统是能控的。
可以通过状态反馈来任意配置极点。
希望的极点为s1=-6,s2=-6.5,s3=-7,s4=-7.5。
3.2 求状态反馈阵
在MA TLAB中输入命定
A=[0 1 0 0;0 0 -1 0;0 0 0 1;0 0 11 0];
B=[0;1;0;-1];
P=[-6 -6.5 -7 -7.5];
K=place(A,B,P)
得到计算结果为:
K=
-204.7500 -122.1750 -488.5000 -149.1750
4 MATLAB程序设计
利用MATLAB/Simulink构造单级倒立摆状态反馈控制系统的仿真模型,如图所示
运行仿真程序,得到的仿真曲线如下图所示
从上图可以看出,可以将倒立摆的杆子控制在与竖直方向偏角θ=0°的位置。
题目二:
根据自身的课题情况,任意选择一个被控对象,按照上题所示步骤进行分析和设计,并给出仿真程序及其执行结果。
解:
塑料球漂浮分析
仿真目标:小球在空中受重力mg ,在竖直向上的风中保持漂浮在空中的稳定状态。
1 建模分析
小球在风向(如图所示)下保持稳定的状态。
小球质量为m ,风速为0v ,简化风对球的阻
y 球 风向
力正比于相对速度,比例系数为f ,球下落正向坐标为y ,输入u 为与风速相关的控制力。
数学模型:
my fy u -=
11222x y x x y f u f u x y y x m m m m
=====
+=+
11220
1010
x x u f x x m m ⎛⎫⎛⎫
⎛⎫⎛⎫ ⎪ ⎪=+ ⎪ ⎪ ⎪ ⎪ ⎪ ⎪⎝⎭⎝⎭⎝⎭⎝⎭
()1210x y x ⎛⎫= ⎪⎝⎭
由数学模型可知可设:
0101A ⎛⎫= ⎪⎝⎭,01B ⎛⎫
= ⎪⎝⎭
,()10C =,()34P =--,()1
2K K K =
2 控制分析
2.1 能控性分析:rank (()B AB )=2,系统能控
2.2 能观性分析:rank (C CA ⎛⎫
⎪⎝⎭
)=2,系统能观 2.3 稳定性分析:12det()0,0,1I A λλλ-===,不全为复实数,故系统不稳定
3 求状态反馈阵K
在matlab 中输入K=place (A,B,P ),可求得反馈阵()128K =。
4 MATLAB 仿真
4.1 Matlab 中simulink 建立
4.2 Matlab中simulink仿真结果
由仿真结果可知,小球会逐渐趋于稳定,模型得到验证。