(完整版)一级倒立摆系统分析
一级倒立摆系统

直线一级倒立摆建模与性能分析直线一级倒立摆建模及性能分析一、数学模型建立在忽略了空气阻力和各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如图1所示。
u 为外界作用力;x 为小车位移; 为摆杆与铅垂方向的夹角;O 、G 分别为摆杆与小车的链接点、摆杆质心的位置;M 为小车的质量;m 为摆杆的质量;J 为摆杆绕G 的转动惯量;l 为O 到摆杆质心的距离,L 为摆杆的长度;0f 为小车与导轨间的滑动摩擦系数,1f 为摆杆绕 O 转动的摩擦阻力矩系数。
对于上图的物理模型我们做以下假设: M :小车质量 m :摆杆质量 b :小车摩擦系数l :摆杆转动轴心到杆质心的长度 I :摆杆惯量 F :加在小车上的力 x :小车位置ɸ:摆杆与垂直向上方向的夹角θ:摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)其机械部分遵守牛顿运动定律,其电子部分遵守电磁学的基本定律。
因此可以通过机理建模得到系统较为精确的数学模型。
应用牛顿力学来建立系统的动力学方程过程如下: 分析小车水平方向所受的合力,可以得到以下方程:N x b F xM --= 由摆杆水平方向的受力进行分析可以得到下面等式:22(sin )d N m x l dtθ=+即:2cos sin N mx ml ml θθθθ=+-把这个等式代入上式中,就得到系统的第一个运动方程:F ml ml x b x m M =-+++θθθθsin cos )(2(1-1) 为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得到下面方程:22(cos )d P mg m l dtθ-=-即:2sin cos P mg ml ml θθθθ-=+力矩平衡方程如下:θθθ I Nl Pl =--cos sin 注意:此方程中力矩的方向,由于θφθφφπθsin sin ,cos cos ,-=-=+=,故等式前面有负号。
合并这两个方程,约去P 和N ,得到第二个运动方程:θθθcos sin )(2xml mgl ml I -=++ (1-2) 1.1 微分方程模型设φπθ+=,当摆杆与垂直向上方向之间的夹角φ与1(单位是弧度)相比很小,即 1<<φ 时,则可以进行近似处理:1cos -=θ,φθ-=sin ,0)(2=dt d θ。
一级倒立摆系统仿真及分析

一级倒立摆系统仿真及分析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 摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)。
直线一级倒立摆的建模及性能分析

直线一级倒立摆的建模及性能分析1 直线一级倒立摆数学模型的建立 (1)2 直线一级倒立摆系统的实际模型 (5)3 直线一级倒立摆系统的性能分析 (6)相关理论的介绍 (6)倒立摆系统的性能分析 (7)1 直线一级倒立摆数学模型的建立所谓系统的数学模型,是指利用数学结构来反映实际系统内部之间、系统内部与外部某些主要相关因素之间的精确的定量表示。
数学模型是分析、设计、预测以及控制一个系统的理论基础。
因此,对于实际系统的数学模型的建立就显得尤为重要。
系统数学模型的构建可以分为两种:实验建模和机理建模。
实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号,激励研究对像并通过传感器检测其可观测的输出,应用数学手段建立起系统的输入-输出关系。
机理建模就是在了解研究对象的运动规律的基础上,通过物理、化学的知识和数学手段建立起系统内部的输入-状态关系。
对于倒立摆系统,由于其本身是不稳定的系统,无法通过测量频率特性的方法获取其数学模型,实验建模存在一定的困难。
但是经过小心的假设忽略掉一些次要的因素后,倒立摆系统是一个典型的机电一体化系统,其机械部分遵守牛顿运动定律,其电子部分遵守电磁学的基本定律,因此可以通过机理建模得到系统较为精确的数学模型。
为了简单起见,在建模时忽略系统中的一些次要的难以建模的因素,例如空气阻力、伺服电机由于安装而产生的静摩擦力、系统连接处的松弛程度、摆杆连接处质量分布不均匀、传动皮带的弹性、传动齿轮的间隙等。
将小车抽象为质点,摆杆抽象为匀质刚体,摆杆绕转轴转动,这样就可以通过力学原理建立较为精确的数学模型。
我们可以应用牛顿力学的分析方法或者欧拉-拉格朗日原理建立系统的动力学模型。
对于直线一级倒立摆这样比较简单的系统,我们采用通俗易懂的牛顿力学分析法建模。
为了建立直线一级倒立摆的数学模型,采用如下的坐标系:图1直线一级倒立摆的物理模型其中,F 为加在小车上的力,M 为小车质量,m 为摆杆质量,I 为摆杆惯量, l 为摆杆转动轴心到杆质心的长度,x 为小车位移,φ为摆杆与垂直向上方向的夹角,b 为小车在滑轨上所受的摩擦力,N 和P 为摆杆相互作用力的水平和垂直方向的分量。
演示文稿一阶倒立摆系统模型分析状态反馈与观测器设计

的。为了应用线性系统理论,可在倒立摆平衡位
置附近对系统进行线性化,取 - ,令
• sin , cos 1 并忽略高次项,可得如下方程:
•
x
u mgl
J
c J
ml J
u
第7页,共33页。
• 可以用线性系统理论对倒立摆系统进行控制,选
择状态变量x。
x1 x
x2
x
x3 x4
第15页,共33页。
4.极点配置
• 假设系统要求超调量不超过10%,调整时间为2s,根据公
式
e( / 1 2 ) 10%
ts
4
wn
2
经计算取 0.7, wn 3
可得系统特征方程为
主导极s点2 为 2wns wn2 s2 4.2s 9 0
s1,2 2.1 j2.1424
第16页,共33页。
• 降维观测器状态跟踪误差仿真结果:
第33页,共33页。
21.4174 1 3.9281
0
•
计算
A
28.3480 6.3224
0 0
78.5615 27.9079
0
1
122.1830 0 152.8225 0.6747
第22页,共33页。
• 带状态观测器的状态反馈系统为
v
u
+ x
b
+
A
y c
+ b
xˆ G
xˆ
+
A-GC
K
第23页,共33页。
T
A22
T
A12
K)
a(s)
•得
30 0
K
0
29.3253
直线一级倒立摆系统实验报告

直线一级倒立摆系统实验报告1. 实验目的:通过对直线一级倒立摆系统进行分析,掌握系统的基本原理、参数设置和控制策略;提高学生实际动手能力和科学实验能力。
2. 实验内容:(1)搭建直线一级倒立摆系统实验平台;(2)设置系统的动力学模型,采集系统的状态变量;(3)根据系统的特性设计控制策略,实现系统的稳定控制;(4)记录实验数据,并进行数据处理和分析。
3. 实验原理:直线一级倒立摆系统是一种经典的非线性控制系统,其原理和稳定性分析可以使用动力学建模方法来描述。
系统由直线弹簧、质量块、直线导轨和质量块的摆杆组成。
当摆杆处于垂直状态时,系统处于平衡状态;当摆杆被扰动后,系统进入不稳定状态,需要通过控制策略来实现其稳定控制。
在实验中,我们选取了单摆系统作为直线一级倒立摆系统的原形。
单摆系统由一个质点和一个线性弹簧组成,其状态变量为质点的位置和速度。
当质点处于平衡位置时,系统拥有稳定状态;当质点被扰动后,系统进入不稳定状态,需要通过控制策略来实现其稳定控制。
因此,我们可以使用单摆系统来研究直线一级倒立摆系统的控制策略。
4. 实验步骤:(1)搭建实验平台:搭建直线一级倒立摆系统实验平台,包括直线导轨、摆杆、质点、力传感器、位移传感器和控制电路等。
将质点放置在导轨上,并用摆杆将其固定在弹簧上。
使用力传感器和位移传感器来测量系统的状态变量。
(2)设置系统模型:对实验平台的动力学模型进行建模,将系统的状态变量与控制策略联系起来。
(3)设计控制策略:根据系统的特性设计相应的控制策略,使系统保持稳定状态。
常用的控制策略包括模型预测控制、PID控制、滑模控制等。
(4)记录实验数据:实验过程中需要记录系统的状态变量和控制参数,并进行数据处理和分析,得到实验结论。
5. 实验结果分析:通过对直线一级倒立摆系统的实验研究,我们发现系统的稳定控制需要根据其特性和实际情况来确定相应的控制策略。
在实验中,我们采用了模型预测控制策略,通过对系统的状态变量进行预测和调节,成功实现了系统的稳定控制。
一级倒立摆控制系统设计

基于双闭环PID控制的一阶倒立摆控制系统设计一、设计目的倒立摆是一个非线性、不稳定系统,经常作为研究比较不同控制方法的典型例子。
设计一个倒立摆的控制系统,使倒立摆这样一个不稳定的被控对象通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统。
、设计要求倒立摆的设计要求是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡和过大的角度和速度。
当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。
实验参数自己选定,但要合理符合实际情况,控制方式为双PID控制,并利用MATLAB进行仿真,并用simulink对相应的模块进行仿真。
二、设计原理倒立摆控制系统的工作原理是:由轴角编码器测得小车的位置和摆杆相对垂直方向的角度,作为系统的两个输出量被反馈至控制计算机。
计算机根据一定的控制算法,计算出空置量,并转化为相应的电压信号提供给驱动电路,以驱动直流力矩电机的运动,从而通过牵引机构带动小车的移动来控制摆杆和保持平衡。
四、设计步骤首先画出一阶倒立摆控制系统的原理方框图一阶倒立摆控制系统示意图如图所示:工业控制计算机电动机驱动器一阶倒立摆一阶倒立摆控制系统动态结构图F面的工作是根据结构框图,分析和解决各个环节的传递函数!1. 一阶倒立摆建模在忽略了空气流动阻力,以及各种摩擦之后,可将倒立摆系统抽象成小车和匀质杆组成的系统,如下图所示,其中:M小车质量m为摆杆质量J :为摆杆惯量F:加在小车上的力x :小车位置摆杆与垂直向上方向的夹角l :摆杆转动轴心到杆质心的长度根据牛顿运动定律以及刚体运动规律,可知:(1) 摆杆绕其重心的转动方程为J鎳F y lsin 二- F x l cos: (1)(2) 摆杆重心的运动方程为F x d2(x l sin r)彳『=mg-m d2 d2t(3) 小车水平方向上的运动为-1-L+10-0一4即 G 1(s)=' ; G 2(s)='-一阶倒立摆环节问题解决!2. 电动机驱动器选用日本松下电工MSMA02型小惯量交流伺服电动机,其有关参数如下:F — F x 二 M d 2x联列上述4个方程,可以得出一阶倒立精确气模型:J ml 2F ml J ml 2sin u 2-m 2l 2gsin r COST2 2 2 2J ml j[ M m :-m l cos )mlcos v.F m 2l 2sin vcos m 2-<; M m mlg sin vm 2l 2cos 20—(M + m )(J +ml 2)式中J 为摆杆的转动惯量:J 』3若只考虑B 在其工作点附近B 0=0附近(-10 —”:10 )的细微变化,则可 以近似认为: 石2“* sin^比日 cos 日“若取小车质量M=2kg,摆杆质量 m=1kg,摆杆长度2 l =1m,重力加速度取g=10m/s 2,则可以得阶倒立摆简化模型:x =0.44F -3.33^ v - -0.4 F 12^拉氏变换=^>日(s)』F(s) x(s) ?(s)-0.42s-122 -1.1s 102 s2(J ml 2)F -m 2l 2g J J(M m) Mml (M m)mlg mlF J(M m) Mml电磁时间常数:Tl=0.001s电机时间常数:TM=0.003s经传动机构变速后输出的拖动力为: F=0~16N 与其配套的驱动器为:MSDA021A1A S 制电压:UDA=0± 10V 。
一阶倒立摆系统模型分析状态反馈与观测器设计

一阶倒立摆系统模型分析状态反馈与观测器设计一阶倒立摆系统是控制工程中常见的一个具有非线性特点的系统,它由一个摆杆和一个质点组成,质点在摆杆上下移动,而摆杆会受到重力的作用而产生摆动,需要通过控制来实现倒立的功能。
以下是一阶倒立摆系统的模型分析、状态反馈与观测器设计的详细介绍。
一、系统模型分析:一阶倒立摆系统是一个非线性动力学系统,可以通过线性化的方式来进行模型分析。
在进行线性化之前,首先需要确定系统的状态变量和输入变量。
对于一阶倒立摆系统,可以将摆杆角度和质点位置作为状态变量,将水平推力作为输入变量。
在对系统进行线性化之后,可以得到系统的状态空间表达式:x_dot = A*x + B*uy=C*x+D*u其中,x是状态向量,u是输入向量,y是输出向量。
A、B、C和D是系统的矩阵参数。
二、状态反馈设计:状态反馈是一种常用的控制方法,通过测量系统状态的反馈信号,计算出控制输入信号。
在设计状态反馈控制器之前,首先需要确定系统的可控性。
对于一阶倒立摆系统,可以通过可控性矩阵的秩来判断系统是否是可控的。
如果可控性矩阵的秩等于系统的状态数量,则系统是可控的。
在确定系统可控性之后,可以通过状态反馈控制器来实现控制。
状态反馈控制器的设计可以通过选择适当的反馈增益矩阵K来实现。
具体的设计方法是,根据系统的状态空间表达式,将状态反馈控制器加入到系统模型中。
状态反馈控制器的输入是状态变量,输出是控制输入变量。
然后,通过调节反馈增益矩阵K的值,可以实现对系统的控制。
三、观测器设计:观测器是一种常用的状态估计方法,通过测量系统的输出信号,估计系统的状态。
在设计观测器之前,首先需要确定系统的可观性。
对于一阶倒立摆系统,可以通过可观性矩阵的秩来判断系统是否是可观的。
如果可观性矩阵的秩等于系统的状态数量,则系统是可观的。
在确定系统可观性之后,可以通过观测器来实现状态估计。
观测器的设计可以通过选择适当的观测增益矩阵L来实现。
具体的设计方法是,根据系统的状态空间表达式,将观测器加入到系统模型中。
一级倒立摆实验报告

一级直线倒立摆极点配置控制实验一、实验目的1.运用经典控制理论控制直线一级倒立摆,包括实际系统模型的建立、根轨迹分析和控制器设计、PID 控制分析等内容。
2.熟悉利用极点配置方法来进行倒立摆实验的原理方法。
3.学习MATLAB工具软件在控制工程中的应用。
3.掌握对实际系统进行建模的方法,熟悉利用MATLAB 对系统模型进行仿真,利用学习的控制理论对系统进行控制器的设计,并对系统进行实际控制实验,对实验结果进行观察和分析,非常直观的感受控制器的控制作用。
二、实验设备计算机及MATLAB相关软件元创兴倒立摆系统的软件元创兴一级直线倒立摆系统,包括运动卡和倒立摆实物倒立摆相关安装工具三、倒立摆系统介绍倒立摆是进行控制理论研究的典型实验平台。
由于倒立摆系统的控制策略和杂技运动员顶杆平衡表演的技巧有异曲同工之处,极富趣味性,而且许多抽象的控制理论概念如系统稳定性、可控性和系统抗干扰能力等等,都可以通过倒立摆系统实验直观的表现出来。
学习自动控制理论的学生通过倒立摆系统实验来验证所学的控制理论和算法,非常的直观、简便,在轻松的实验中对所学课程加深了理解。
倒立摆不仅仅是一种优秀的教学实验仪器,同时也是进行控制理论研究的理想实验平台。
由于倒立摆系统本身所具有的高阶次、不稳定、多变量、非线性和强耦合特性,许多现代控制理论的研究人员一直将它视为典型的研究对象,不断从中发掘出新的控制策略和控制方法,相关的科研成果在航天科技和机器人学方面获得了广阔的应用。
四、倒立摆工作原理和物理模型以及数学模型(简述)1、工作原理:数据采集卡(也称运动控制卡,安装于计算机机箱的PCI插槽上)采集到旋转编码器数据和电机尾部编码器数据,旋转编码器与摆杆同轴,电机与小车通过皮带连接,所以通过计算就可以得到摆杆的角位移以及小车位移,角位移差分得角速度,位移差分可得速度,然后根据自动控制中的各种理论转化的算法计算出控制量。
控制量由计算机通过运动控制卡下发给伺服驱动器,由驱动器实现对电机控制,电机尾部编码器连接到驱动器形成闭环,从而可以实现闭环控制。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
一级倒立摆的系统分析一、倒立摆系统的模型建立如图1-1所示为一级倒立摆的物理模型图1-1 一级倒立摆物理模型对于上图的物理模型我们做以下假设:M:小车质量m:摆杆质量b:小车摩擦系数l:摆杆转动轴心到杆质心的长度I:摆杆惯量F:加在小车上的力x:小车位置ɸ:摆杆与垂直向上方向的夹角θ:摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)图1-2是系统中小车和摆杆的受力分析图。
其中,N和P为小车与摆杆相互作用力的水平和垂直方向的分量。
注意:实际倒立摆系统中的检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示,图示方向为矢量正方向。
图1-2 小车及摆杆受力分析分析小车水平方向受力,可以得到以下方程:M ẍ=F-bẋ-N (1-1)由摆杆水平方向的受力进行分析可以得到以下方程:N =md 2dt 2(x +l sin θ) (1-2)即: N =mẍ+mlθcos θ−mlθ2sin θ (1-3)将这个等式代入式(1-1)中,可以得到系统的第一个运动方程: (M +m )ẍ+bẋ+mlθcos θ−mlθ2sin θ=F (1-4)为推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得出以下方程: P −mg =md 2dt 2(l cos θ) (1-5)P −mg =− mlθsin θ−mlθ2cos θ (1-6) 利用力矩平衡方程可以有:−Pl sinθ−Nl cosθ=Iθ (1-7)注意:此方程中的力矩方向,由于θ=π+ɸ,cosɸ=−cosθ,sinɸ=−sinθ,所以等式前面含有负号。
合并两个方程,约去P和N可以得到第二个运动方程:(I+ml2)θ+mgl sinθ=−mlẍcosθ (1-8)设θ=π+ɸ,假设ɸ与1(单位是弧度)相比很小,即ɸ<<1,则可以进行近似处理:cosθ=−1,sinθ=−ɸ,(dθdt )2=0。
用u来代表被控对象的输入力F,线性化后的两个运动方程如下:{(I+ml2)ɸ−mglɸ=mlẍ(M+m)ẍ+bẋ−mlɸ=u(1-9)假设初始条件为0,则对式(1-9)进行拉普拉斯变换,可以得到:{(I+ml2)Φ(s)s2−mglΦ(s)=mlX(s)s2(M+m)X(s)s2+bX(s)s−mlΦ(s)s2=U(s) (1-10) 由于输出为角度ɸ,求解方程组的第一个方程,可以得到:X(s)=[(I+ml2)ml −gs2]Φ(s) (1-11)或改写为:Φ(s)X(s)=mls2(I+ml2)s2−mgl(1-12)如果令v=ẍ,则有:Φ(s)V(s)=ml(I+ml2)s2−mgl(1-13)如果将上式代入方程组的第二个方程,可以得到:(M+m)[(I+ml2)ml −gs]Φ(s)s2+b[(I+ml2)ml+gs2]Φ(s)s−mlΦ(s)s2=U(s) (1-14) 整理后可得传递函数:Φ(s) U(s)=mlqs2s4+b(I+ml2)qs3−(M+m)mglqs2−bmglqs(1-15)其中q=[(M+m)(I+ml2)−(ml)2]假设系统状态空间方程为:X=AX+Buy=CX+Du (1-16) 方程组对ẍ,ɸ解代数方程,可以得到解如下:{ẋ=ẋẍ=−(I+ml2)bI(M+m)+Mml2ẋ+m2gl2I(M+m)+Mml2ɸ+(I+ml2)I(M+m)+Mml2uɸ=ɸɸ=−mlbI(M+m)+Mml2ẋ+mgl(M+m)I(M+m)+Mml2ɸ+mlI(M+m)+Mml2u(1-17)整理后可以得到系统状态空间方程:[ẋẍɸɸ]=[01000−(I+ml2)bI(M+m)+Mml2m2gl2I(M+m)+Mml200010−mlbI(M+m)+Mml2mgl(M+m)I(M+m)+Mml20][xẋɸɸ]+[(I+ml2)I(M+m)+Mml2mlI(M+m)+Mml2]uy=[xɸ]=[10000010][xẋɸɸ]+[0]u(1-18)由(1-9)的第一个方程为:(I+ml2)ɸ−mgl ɸ=mlẍ对于质量均匀分布的摆杆可以有:I=13ml2于是可以得到:(13ml2+ml2)ɸ−mgl ɸ=mlẍ化简可以得到:ɸ=3g4l ɸ+34lẍ(1-19)设X={x, ẋ, ɸ , ɸ},u=ẍ则有:[ẋẍɸɸ]=[010000000001003g4l0][xẋɸɸ]+[134l]uy=[xɸ]=[10000010][xẋɸɸ]+[0]u(1-20)以上公式推理是根据牛顿力学的微分方程验证的。
在实际系统中模型参数如下:M 小车质量1.096 Kgm 摆杆质量0.109 Kgb 小车摩擦系数0 .1N/m/secl 摆杆转动轴心到杆质心的长度0.2 5mI 摆杆惯量0.0034 kg*m*m将上述参数代入,就可以得到系统的实际模型。
摆杆角度和小车位移的传递函数:Φ(s) X(s)=0.02725s20.0102125s2−0.26705(1-21)摆杆角度和小车加速度之间的传递函数为:Φ(s) V(s)=0.027250.0102125s2−0.26705(1-22)摆杆角度和小车所受外界作用力的传递函数:Φ(s) U(s)= 2.35655ss3+0.0883167s2−27.9169s−2.30942(1-23)以外界作用力作为输入的系统状态方程:[ ẋẍ ɸɸ]=[01000−0.08831670.629317000010−0.23565527.82850][x ẋɸɸ]+[00.88316702.35655]uy =[x ɸ]=[10000010][x ẋɸɸ]+[0]u (1-24) 以小车加速度作为输入的系统状态方程:[ ẋẍ ɸɸ]=[0100000000010029.40][x ẋɸɸ]+[0103]u y =[x ɸ]=[10000010][xẋɸɸ]+[0]u (1-25) 综述可知以上就是一级倒立摆系统的模型建立过程,最终得出了实际模型的传递函数和状态空间方程。
二、 系统模型的转换以小车加速度作为输入的系统状态方程为例,将系统状态方程转化为能控标准型,能观标准型和约当标准型。
由系统状态方程可知:A =[010000000001029.40] B =[0103]C=[1000]0010]D=[01、转化为能控标准型定出系统特征多项式:>> a=poly(A) a =1.0000 -0.0000 -29.4000 0 0 由此可知a0=0, a1=0, a2=-29.4, a3=0。
>> b3=C*Bb3 =b2=C*A*B+a3*C*Bb2 =13>> b1=C*A^2*B+a3*C*A*B+a2*C*Bb1 =>> b0=C*A^3*B+a3*C*A^2*B+a2*C*A*B+a1*C*Bb0 =-29.4000所以系统的能控标准型为:[ẋ1ẍ1ɸ1ɸ1]=[0 10000 1000010029.40][x1x1ɸ1ɸ1]+ [1]uy=[−29.40100030][x1x1ɸ1ɸ1]+[0]u2、转化为能观标准型利用对偶性求出能观标准型为:[ẋ1ẍ1ɸ1ɸ1]=[0 00010 0001029.40010][x1x1ɸ1ɸ1]+ [0−29.4003300]u y=[0001][x1x1ɸ1ɸ1]3、转化为约当标准型首先求出系统的特征值以及相应的特征向量:A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0]A =0 1.0000 0 00 0 0 00 0 0 1.00000 0 29.4000 0>> [V,D]=eig(A)V =0 0 1.0000 -1.00000 0 0 0.00000.1814 -0.1814 0 00.9834 0.9834 0 0D =5.4222 0 0 00 -5.4222 0 00 0 0 00 0 0 0其中D表示A全部特征值构成的对角阵,V表示相对应的特征向量。
求出变换矩阵V的逆:>> V1=inv(V)Warning: Matrix is close to singular or badly scaled.Results may be inaccurate. RCOND = 1.720635e-292.V1 =1.0e+291 *0 0 0.0000 0.00000 0 -0.0000 0.00000.0000 2.4948 0 00 2.4948 0 0计算变换后的系数矩阵:>> A1=V1*A*VA1 =5.4222 0 0 00.0000 -5.4222 0 00 0 0 0.00000 0 0 0 B1=V1*BB1 =1.0e+291 *0.00000.00002.49482.4948所以系统的约当标准型为:[ẋ1 ẍ1ɸ1ɸ1]=[5.4222 0000−5.4222 0000000000][x1x1ɸ1ɸ1]+ 1.0e+291 ∗[2.49482.4948]u三、开环阶跃响应曲线及分析利用已知的状态空间方程来进行阶跃响应分析,在MATLAB中可以写入以下命令:>> A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0];>> B=[0;1;0;3];>> C=[1 0 0 0;0 1 0 0];>> D=[0;0];>> step(A,B,C,D)可以看出,在单位阶跃响应作用下,小车位置和摆杆角度都是发散的。
四、判断系统稳定性判断系统的稳定性可以利用根轨迹来判断,已知实际系统的开环传递函数为:Φ(s)V(s)=0.027250.0102125s2−0.26705,则其根轨迹图形可以利用MATLAB键入如下命令来完成。
>> num=[0.02725];>> den=[0.0102125 0 -0.26705]; >> z=roots(num)z =Empty matrix: 0-by-1>> p=roots(den)p =5.1136-5.1136>> rlocus(num,den)可以看出系统没有零点,有两个极点,并且有一个极点为正。
由画出的根轨迹图形可以看出闭环传递函数的一个极点位于复平面的右半平面,这就意味着系统是一个不稳定的系统。
五、 能控性和能观性分析对于系统的能控性和能观性分析,可以利用能控性秩判据和能观性秩判据。
能控性秩判据:对于n 维连续时间线性时不变系统,构成能控性判别矩阵:Q c =[B ⋮AB ⋮⋯⋮A n−1B],则系统完全能控的充要条件为:rankQ c =rank [B ⋮AB ⋮⋯⋮A n−1B ]=n能观性秩判据:对于n 维连续时间线性时不变系统,构成能观性判别矩阵:Q o =[C CA ⋮CA n−1],则系统完全能观的充要条件为: rankQ o =rank [C CA ⋮CA n−1]=n 利用MATLAB 键入以下命令来进行判断:>> A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0];>> B=[0;1;0;3];>> C=[1 0 0 0;0 1 0 0];>> D=[0;0];>> Qc=[B A*B A^2*B A^3*B]Qc =0 1.0000 0 01.0000 0 0 00 3.0000 0 88.20003.0000 0 88.2000 0>> R1=rank(Qc)R1 =4>> Qo=[C;C*A;C*A^2;C*A^3]Qo =1 0 0 00 1 0 00 1 0 00 0 0 00 0 0 00 0 0 00 0 0 00 0 0 0>> R2=rank(Qo)R2 =2可以看出,系统的完全能控矩阵的秩等于系统的状态变量维数,系统的输出完全能观测矩阵的秩等于系统输出向量y的维数,所以系统是可以完全能控完全能观测的系统。