倒立摆系统地建模及Matlab仿真

倒立摆系统地建模及Matlab仿真
倒立摆系统地建模及Matlab仿真

倒立摆系统的建模及Matlab仿真

1.系统的物理模型

考虑如图(1)

面内运动的二维问题。

图(1)倒立摆系统

假定倒立摆系统的参数如下。

摆杆的质量:m=0.1g

摆杆的长度:l=1m小车的质量:

M=1kg重力加速度:g=9.8m/2s

摆杆的质量在摆杆的中心。

设计一个控制系统,使得当给定任意初始条件(由干扰引起)时,最大超调量δ≤10%,调节时间ts ≤4s ,通过小车的水平运动使倒立摆保持在垂直位置。

2.系统的数学模型

2.1建立倒置摆的运动方程并将其线性化。

为简化问题,在数学模型中首先假设:1)摆杆为刚体;2)忽略摆杆与支点之间的摩擦;3)忽略小车与接触面间的摩擦。

设小车瞬时位置为z,摆心瞬时位置为(θ

z+),在u作用下,小车及摆均产生加速远动,

l

sin

根据牛顿第二定律,在水平直线远动方向的惯性力应与u平衡,于是有

u l z dt

d m dt z d M =++)sin (22

22θ 即: u ml ml z m M =-++θθθθsin cos )(2 ① 绕摆轴转动的惯性力矩与重力矩平衡,因而有

θθθsin cos )sin (22mgl l l z dt d m =???

????+ 即: θθθθθθθs i n c o s s i n c o s c o s 22g l l z =-+ ②

以上两个方程都是非线性方程,为求得解析解,需作线性化处理。由于控制的目的是保持倒立摆直

立,在试驾合适的外力条件下,假定θ很小,接近于零时合理的,则1cos ,sin ≈≈θθθ,且可忽略θθ

2 项。于是有

u ml z m M =++θ )( ③ θθg l z

=+ ④ 联立求解可得

u Ml Ml m M u M M mg z

1)(1

-+=+-=θθθ 2.2列写系统的状态空间表达式。

选取系统变量4321,,,x x x x , []T

x x x x x 4321,,,=则

u Ml x Ml m M x

x x u M

x M m g x x x 1

)(134433221-+==+-==

[]Cx

x x y Bu Ax u Ml M x Ml g m M M m g z z dt d x ===+=??????

????????-+??????????

???

?

+-=????

????????=000110100)(0

010*******

10

1θθ

代入数据计算得到:

[][]0,0001,1010,011

00

100001000010==-=?????

????

???-=D C B A T 3.设计控制器

3.1判断系统的能控性和稳定性

[

]

?????

????

???----==01101110100101101

032B A B

A A

B B

Q k ,rank(k Q )=4,故被控对象完全可控 由特征方程 0)11(22=-=-λλλA I 解得特征值为 0,0,11±。出现大于零的特征值,故被控对象不稳定

3.2确定希望的极点

希望的极点n=4,选其中一对为主导极点1s 和2s ,另一对为远极点,认为系统性能主要由主导极点决定,远极点只有微小影响。根据二阶系统的关系式,先确定主导极点

1.02

1≤=--

?πξ

σe p 可得59.0≥ξ,于是取6.0=ξ;取误差带02.0=?有n

s t ξω4

=

,则 1.67=n ω,闭环

主导极点为22,11ξξω-±-=j s n =-1±0.8j,远极点选择使它和原点的距离大于主导极点与原点距离的5倍,取154,3-=s

3.3采用状态反馈方法使系统稳定并配置极点

状态反馈的控制规律为kx u -=,[]32

10

k k k k k =;状态反馈系统的状态方程为

Bv x BK A x

+-=)( ,其特征多项式为 0122033141010)11()()(k k k k k k BK A I ----+-+=--λλλλλ ⑤

希望特征多项式为

3692.49964.28632)8.01)(8.01()15(2342++++=++-++λλλλλλλj j ⑥

比较以上两式系数,解得状态反馈矩阵[]92.8154.33492.499.36----=k

4.设计全维观测器

4.1判断系统的能观性

[]

?

?

???

????

???--==1000

01000010

0001)()(3

2C A C A C A C

Q T T T g ,rank(g Q )=4,故被控对象完全可观 4.2确定观测器的反馈增益

全维观测器的动态方程为GCx Bv x GC A x ++-= )(;其特征多项式为

)11()11()11()(312021304g g g g g g GC A I --+--+-++=--λλλλλ ⑦

取观测器的希望极点为:-45,-45,-3+3j ,-3-3j ;则希望特征多项式为

3465013770258396)8.01)(8.01()15(2342++++=++-++λλλλλλλj j ⑧ 比较以上两式系数,解得观测器反馈矩阵[]T

G 6498414826259496--=

5.降维状态观测器的设计

5.1建立倒置摆三维子系统动态方程

设小车位移z 由输出传感器测量,因而无需估计,可以设计降维(三维)状态观测器,通过重

新排列被控系统变量的次序,把需由降维状态观测器估计的状态变量与输出传感器测得的状态变量分离开。将z 作为第四个状态变量,则被控系统的状态方程和输出方程变换为

[]???

?

?

???????=?????

???????-+???????????????????

???

??-=????????????z z y u z z

z z dt d θθθ

θθθ 10000101000100110010

00010 ⑨

简记为:

[]?

?

?

???==??

????+????????????=??????21121212221

1211210x x I y y u b b x x A A A A x x

式中

[]

T z

x θθ =1,????

?

?????-=011

100010

11A ,[]T A 00012=,T b ]101[1-=

y z x ==2,[]T

A 00121=,21A =0,02=b ,11=I 被控系统的n-q 维子系统动态方程的一般形式为

v x A x

+=1111 ,121x A z =' 式中u u y A v 1121=+=,z y u y A y

z ==--='222 z '为子系统输出量。故倒置摆三维子系统动态方程为

[]????

??????='??????????-+????????????????????-=??????????θθθθθθ z

z u z z dt d 0011010110100010

5.2.判断子系统的可观测性

A1=[0 -1 0;0 0 1;0 11 0];C1= [1 0 0];

Qg1=obsv(A1,C1);r=rank(Qg1)

运行Matlab 程序;结果为r=3,故该子系统可观测 降维状态观测器动态方程的一般形式为()()()[]y h x

y A h A h A h A u b h b A h A +=-+-+-+-=ωωω122122*********

式中h=[]T

h h h 210

。考虑被控对象参数,单倒置摆降维观测器动态方程的一般形式为

y h h h x y h h h h h h h h u h h h ??

??

?

?????+=????

??????+-+---+??

???

?????-+???????

???----=21011202101202

10111010111001ωωω

5.3确定三维状态观测器的反馈矩阵h

三维状态观测器的特征多项式为

()()()20120321111111h h h h A h A I --+--++=--λλλλ

设希望的观测器闭环极点为-45,-3+3j ,-3-3j ,则希望特征多项式为

()()()8102885133334523+++=-++++λλλλλλj j

比较以上两式系数,解得h=[]1371-29951- 故所求三维状态观测器的动态方程为

y y x x y u ?????

?

??????--+??

???????

???=??????=??

??

??????-+??????????-+??????????--=113712995100000100001000016663213878230210101113711029901511ωωω 6.Matlab 仿真分析

6.1源程序

通过Matlab 对用全维状态观测器实现状态反馈的倒置摆系统进行仿真分析,下面是文件名为

Inversion_pendulum_system.m 的源程序 %倒立摆系统建模分析

%a)判断系统能控性和能观性

clear all;

clc

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];

D=0;

Uc=ctrb(A,B);rc=rank(Uc);

n=size(A);

if rc==n

disp('The system is controlled.')

elseif rc

disp('The system is uncontrolled.')

end

Vo=obsv(A,C);

ro=rank(Vo);

if ro==n

disp('The system is observable.')

elseif ro~=n

disp('The system is no observable.')

end

%b)判断系统稳定性

P=poly(A),v=roots(P)

Re=real(v);

if(length(find(Re>0))~=0)

disp('The system is unstable and the ubstable poles are:')

v(find(Re>0))

else

disp('The system is stable!');

end

% c)极点配置与控制器-全维状态观测器设计与仿真

pc=[-1+0.8*j,-1-0.8*j,-15,-15];po=[-45 -45 -3+3*j -3-3*j];

K=acker(A,B,pc),G=acker(A',C',po)'

Gp=ss(A,B,C,D); %将受控过程创建为一个LTI对象

disp('受控对象的传递函数模型:');

H=tf(Gp)

Af=A-B*K-G*C;

disp('观测器——控制器模型:');

Gc=ss(Af,-G,-K,0) %将观测器-控制器创建为一个LTI对象disp('观测器——控制器的极点:');

f_poles=pole(Gc)

GpGc=Gp*Gc; %控制器和对象串联

disp('观测器——控制器与对象串联构成的闭环系统模型:'); Gcl=feedback(GpGc,1,-1) %闭环系统

disp('闭环系统的极点和零点:');

c_poles=pole(Gcl)

c_zeros=tzero(Gcl)

lfg=dcgain(Gcl) %低频增益

N=1/lfg % 归一化常数

T=N*Gcl; %将N与闭环系统传递函数串联

x0=[100 10 30 10 0 0 0 0];%初始条件向量

t=[0:0.01:1]'; %时间列向量

r=0*t; %零参考输入

[y t x]=lsim(T,r,t,x0); %初始条件仿真

plot(t,x(:,1:4),'-.',t,x(:,5:8)) %由初始条件引起的状态响应title('\bf状态响应')

legend('x1','x2','x3','x4','x1hat','x2hat','x3hat','x4hat')

figure(2)

step(T)

title('\bf阶跃响应')

figure(3)

impulse(T)

title('\bf脉冲响应')

6.2 程序运行结果

The system is controlled.

The system is observable.

P =

1 0 -11 0 0

v =

3.3166

-3.3166

The system is unstable and the ubstable poles are:

ans =

3.3166

K =

-36.9000 -49.9200 -334.5400 -81.9200

G =

96

2594

-14826

-64984

受控对象的传递函数模型

Transfer function:

s^2 - 1.776e-015 s - 10

-----------------------

s^4 - 11 s^2

观测器——控制器模型:

a =

x1 x2 x3 x4

x1 -96 1 0 0

x2 -2557 49.92 333.5 81.92

x3 1.483e+004 0 0 1

x4 6.495e+004 -49.92 -323.5 -81.92

b =

u1

x1 -96

x2 -2594

x3 1.483e+004

x4 6.498e+004

c =

x1 x2 x3 x4

y1 36.9 49.92 334.5 81.92

d =

u1

y1 0

Continuous-time model.

观测器——控制器的极点:

f_poles =

1.0e+002 *

-1.4948 + 1.8786i

-1.4948 - 1.8786i

1.7424

-0.0328

观测器——控制器与对象串联构成的闭环系统模型:

a =

x1 x2 x3 x4 x5 x1 0 1 0 0 0 x2 0 0 -1 0 36.9 x3 0 0 0 1 0 x4 0 0 11 0 -36.9 x5 96 0 0 0 -96 x6 2594 0 0 0 -2557 x7 -1.483e+004 0 0 0 1.483e+004

x8 -6.498e+004 0 0 0 6.495e+004 x6 x7 x8

x1 0 0 0

x2 49.92 334.5 81.92

x3 0 0 0

x4 -49.92 -334.5 -81.92

x5 1 0 0

x6 49.92 333.5 81.92

x7 0 0 1

x8 -49.92 -323.5 -81.92

b =

u1

x1 0

x2 0

x3 0

x4 0

x5 -96

x6 -2594

x7 1.483e+004

x8 6.498e+004

c =

x1 x2 x3 x4 x5 x6 x7 x8

y1 1 0 0 0 0 0 0 0

d =

u1

y1 0

Continuous-time model.

闭环系统的极点和零点:

c_poles =

-45.0000

-45.0000

-15.0001

-14.9999

-3.0000 + 3.0000i

-3.0000 - 3.0000i

-1.0000 + 0.8000i

-1.0000 - 0.8000i

c_zeros =

3.1623

0.2263

-0.1707

-3.4312

-3.1623

lfg =

1.0000

N =

1.0000

由控制器——全维状态观测器实现的倒立摆系统在初始条件下引起的状态变量的响应、输出变量的阶跃响应和脉冲响应如下图

图(2)状态响应()t x(虚线)和()t x (实线)

图(3)阶跃响应()t y

图(4)脉冲响应()t y

基于MATLAB(矩阵实验室)的倒立摆控制系统仿真

基于MATLAB(矩阵实验室)的倒立摆控制系统仿真 摘要 自动控制原理(包括经典部分和现代部分)是电气信息工程学院学生的一门必修专业基础课,课程中的一些概念相对比较抽象,如系统的稳定性、可控性、收敛速度和抗干扰能力等。倒立摆系统是一个典型的非线性、强耦合、多变量和不稳定系统,作为控制系统的被控对象,它是一个理想的教学实验设备,许多抽象的控制概念都可以通过倒立摆直观地表现出来。本文以一级倒立摆为被控对象,用经典控制理论设计控制器(PID控制器)的设计方法和用现代控制理论设计控制器(极点配置)的设计方法,通过MATLAB仿真软件的方法来实现。 关键词:一级倒立摆PID控制器极点配置

Inverted pendulum controlling system simulation based on the MATLAB ABSTRACT Automatic control theory (including classical parts and modern parts) is a compulsory specialized fundamental course of the students majored in electrical engineering. Some of the curriculum concept is relatively abstract, such as the stability, controllability, convergence rate and the anti-interference ability of system. Inverted pendulum system is a typical nonlinear, strong coupling, multivariable and unstable system. It is an ideal teaching experimental equipment as a controlled object, by which many abstract control concepts can be came out directly. This paper chose first-order inverted pendulum as the controlled object. First, the PID controller was designed with classical control theory. Then pole-assignment method was discussed with modern control theory. At last, the effectness of the two methods was verified by MATLAB simulation software. KEY WORDS: First-order inverted pendulum PID controller pole-assignment

APF matlab仿真建模要点

电力电子系统建模与仿真 学院:电气工程学院 年级:2012级 学号:12031236 姓名:周琪俊 指导老师:舒泽亮

二极管钳位多电平APF电压平衡SPWM仿真报告 1 有源电力滤波器的发展及现状 有源电力滤波器的发展最早可以追溯到20 世纪60 年代末,1969 年B.M.Bird 和J.F.Marsh发表的论文中,描述了通过向电网注入三次谐波电流来减少电源电流中的谐波成分,从而改善电源电流波形的新方法,这种方法是APF 基本思想的萌芽。1971年日本的H.Sasaki 和T.Machida 首先提出APF 的原始模型。1976 年美国西屋电气公司的L.Gyugyi 等提出了用PWM 变流器构成的APF 并确立了APF 的概念。这些以PWM 变流器构成的APF 已成为当今APF 的基本结构。但在70 年代由于缺少大功率的快速器件,因此对APF 的研究几乎没有超出实验室的范围。80 年代以来,随着新型电力半导体器件的出现,脉宽调制的发展,以及H.Akagi 的基于瞬时无功功率理论的谐波电流瞬时检测方法的提出,APF有了迅速发展。 现在日本、美国、德国等工业发达国家APF已得到了高度重视和日益广泛的应用。由于理论研究起步较早,目前国外有源电力滤波器的研究已步入工业化应用阶段。随着容量的逐步提高,其应用范围也从补偿用户自身的谐波向改善整个电网供电质量的方向发展。有源电力滤波器的工业化应用对理论研究起了非常大的推动作用,新的理论研究成果不断出现。1976 年美国西屋公司的L.Gyugyi 率先研制出800kV A的有源电力滤波器。在此以后的几十年里,有源电力滤波器的实践应用得到快速发展。在一些国家,已经投入工业应用的有源电力滤波器容量已增加到50MV A。目前大部分国际知名的电气公司如西屋电气、三菱电机、西门子和梅兰日兰等都有相关的部门都已有相关的产品。 我国在有源电力滤波器的研究方面起步较晚,直到20 世纪80 年代末才有论文发表。90 年代以来一些高等院校和科研机构开始进行有源电力滤波器的研究。1991 年12 月由华北电科院、北京供电局和冶金部自动化研究所研制的国内第一台400V/50kV A 的有源电力滤波器在北京某中心变电站投运,2001 年华北电科院又将有源电力滤波器的容量提高到了10kV/480kV A。由中南大学和湖南大学研制的容量为500kV A 并联混合型有源电力滤波器已在湖南娄底早元220kV 变电站挂网运行。在近几年国内的有源电力滤波器产品已有很多应用,本文研制的两种APF都已应用于工业现场。 2 二极管箝位式多电平逆变器 自从日本学者南波江章于1980 年提出三电平中性点箝位逆变器以来,多电平逆变器的拓扑结构就受到人们的普遍关注,很多学者相继提出了一些实际应用

一级倒立摆的建模与控制分析

控制工程与仿真课程设计报告 报告题目直线一级倒立摆建模、分析及控制器的设计 组员1专业、班级14自动化1 班姓名朱永远学号1405031009 组员1专业、班级14自动化1 班姓名王宪孺学号1405031011组员1专业、班级14自动化1 班姓名孙金红学号1405031013 报告评分标准 评分项目权重评价内容评价结果项目得分 内容70设计方案较合 理、正确,内容 较完整 70-50分 设计方案基本合 理、正确,内容 基本完整 50-30分 设计方案基本不 合理、正确,内 容不完整 0-30分 语言组织15语言较流顺,标 点符号较正确 10-15分语言基本通顺, 标点符号基本正 确 5-10分 语言不通顺,有 错别字,标点符 号混乱 5分以下 格式15 报告格式较正 确,排版较规范 美观 10-15分 报告格式基本正 确,排版不规范 5-10分 报告格式不正 确,排版混乱 5分以下总分

直线一级倒立摆建模、分析及控制器的设计 一状态空间模型的建立 1.1直线一级倒立摆的数学模型 图1.1 直线一级倒立摆系统 本文中倒立摆系统描述中涉及的符号、物理意义及相关数值如表1.1所示。

图1.2是系统中小车的受力分析图。其中,N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量。 图1.2 系统中小车的受力分析图 图1.3是系统中摆杆的受力分析图。F s 是摆杆受到的水平方向的干扰力, F h 是摆杆受到的垂直方向的干扰力,合力是垂直方向夹角为α的干扰力F g 。

图1.3 摆杆受力分析图 分析小车水平方向所受的合力,可以得到以下方程: ()11- 设摆杆受到与垂直方向夹角为α 的干扰力Fg ,可分解为水平方向、垂直方向的干扰力,所产生的力矩可以等效为在摆杆顶端的水平干扰力FS 、垂直干扰力Fh 产生的力矩。 ()21- 对摆杆水平方向的受力进行分析可以得到下面等式: ()θsin 22 l x dt d m F N S +=- ()31- 即: αθθθθsin sin cos 2f F ml ml x m N +-+= ()41- 对图1.3摆杆垂直方向上的合力进行分析,可以得到下面方程: ()θcos 22 l l dt d m F mg P h -=++- ()51- 即 θθθθ αcos sin cos 2 ml ml F mg P g +=++- ()61- 力矩平衡方程如下: 0cos sin sin cos cos sin =++++θθθθαθα I Nl Pl l F l F g g ()71- 代入P 和N ,得到方程: () 0cos 2sin sin 2cos sin cos 2cos sin 2222=+-++++θθθθθθθαθαx ml ml mgl ml I l F l F g g ()81- 设φπθ+=,(φ是摆杆杆与垂直向上方向之间的夹角,单位是弧度),代入上式。假设φ<<1,则可进行近似处理: φφφφφφφ===?? ? ??==2sin ,12cos ,0,sin ,1cos 2 dt d N x f F x M --= α sin g S F F =α cos g h F F =

倒立摆系统的建模及Matlab仿真资料

第1 页共11 页 倒立摆系统的建模及Matlab仿真 1.系统的物理模型 考虑如图(1)所示的倒立摆系统。图中,倒立摆安装在一个小车上。这里仅考虑倒立摆在图面内运动的二维问题。 图(1)倒立摆系统 假定倒立摆系统的参数如下。 摆杆的质量:m=0.1g l=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?????d MM??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?。出现大于零的特征值,故被,,0 解得特征值为 0由特征方程0??11I?A?)(控对象不稳定3.2确定希望的极点, 另一对为远极点,认为系统性能主要由主导,选其中一对为主导极点和希望的极点n=4ss21极点决定,远极点只有微小影响。根据二阶系统的关系式,先确定主导极点???42??1????10.?e??t1.67?有,闭环可得;取误差带,于是取,则6.?059?0.02.?0? pns??n2????1?js??=-10.8j,远极点选择使它和原点的距离大于主导极点与原点 距离主导极点为?n,21s??15倍,取的54,33.3采用状态反馈方法使系统稳定并配置极点 ??kkkk?k;状态反馈系统的状态方程,馈状态反的控制规律为为kxu??3102?,其

基于matlab的一级倒立摆自适应仿真

第一章绪论 1.1倒立摆系统的简介 1.1.1倒立摆系统的研究背景及意义 倒立摆系统的最初分析研究开始于二十世纪五十年代,是一个比较复杂的不稳定、多变量、带有非线性和强耦合特性的高阶机械系统,它的稳定控制是控制理论应用的一个典型范例[1]。倒立摆系统存在严重的不确定性,一方面是系统的参数的不确定性,一方面是系统的受到不确定因素的干扰。通过对它的研究不仅可以解决控制中的理论问题,还将控制理论涉及的相关主要学科:机械、力学、数学、电学和计算机等综合应用。在多种控制理论与方法的研究和应用中,特别是在工程中,存在一种可行性的实验问题,将其理论和方法得到有效的验证,倒立摆系统可以此提供一个从控制理论通过实践的桥梁。近些年来,国内外不少专家、学者一直将它视为典型的研究对象,提出了很多控制方案,对倒立摆系统的稳定性和镇定问题进行了大量研究,都在试图寻找不同的控制方法实现对倒立摆的控制,以便检查或说明该方法的严重非线性和绝对不稳定系统的控制能力,其控制方法在军工、航天、机械人领域和一般工业过程中都有着广泛的用途,如精密仪器的加工、机器人行走过程中的平衡控制、火箭发射中的垂直度控制、导弹拦截控制、航空对接控制、卫星飞行中的姿态控制等方面均涉及到倒置问题。因此,从控制这个角度上讲,对倒立摆的研究在理论和方法论上均有着深远意义。倒立摆系统是一个典型的自不稳定系统,其中摆作为一个典型的振动和运动问题,可以抽象为许多问题来研究。随着非线性科学的发展,以前的采用线性化方法来描述非线性的性质,固然无可非议,但这种方法是很有局限性,非线性的一些本质特征往往不是用线性的方法所能体

现的。非线性是造成混乱、无序或混沌的核心因素,造成混乱、无序或混沌并不意味着需要复杂的原因,简单的非线性就会产生非常的混乱、无序或混沌。在倒立摆系统中含有极其丰富和复杂的动力学行为,如分叉、分形和混沌动力学,这方面的问题也值得去探讨和研究。 无论哪种类型的倒立摆系统都具有如下特性[2]: (1)非线性倒立摆是一个典型的非线性复杂系统。实际中可以通过线性化得到系统的近似模型,线性化处理后再进行控制,也可以利用非线性控制理论对其进行控制,倒立摆的非线性控制正成为一个研究的热点。 (2)不确定性主要是指建立系统数学模型时的参数误差、量测噪声以及机械传动过程中的减速齿轮间隙等非线性因素所导致的难以量化的部分。 (3)欠冗余性一般的,倒立摆控制系统采用单电机驱动,因而它与冗余机构,比如说冗余机器人有较大的不同。之所以采用欠冗余的设计是要在不失系统可靠性的前提下节约经济成本或者节约有效的空间。研究者常常是希望通过对倒立摆控制系统的研究获得性能较为突出的新型控制器设计方法,并验证其有效性及控制性能。 (4)耦合特性倒立摆摆杆和小车之间,以及多级倒立摆系统的上下摆杆之间都是强耦合的。这既是可以采用单电机驱动倒立摆控制系统的原因,也是使得控制系统的设计、控制器参数调节变得复杂的原因。 (5)开环不稳定性倒立摆系统有两个平衡状态:垂直向下和垂直向上。垂直向下的状态是系统稳定的平衡点(考虑摩擦力的影响),而垂直向上的状态是系统不稳定的平衡点,开环时微小的扰动都会使系统离开垂直向上的状态而进入到垂直向下的状态中。 (6)约束限制由于实际机构的限制,如运动模块行程限制,电机力矩限制等。为制造方便和降低成本,倒立摆的结构尺寸和电机功率都尽量要求最小,行程限制对于倒立

倒立摆姿态控制模型

倒立摆 倒立摆百度文库解释: 倒立摆系统的输入为小车的位移(即位置)和摆杆的倾斜角度期望值,计算机在每一个采样周期中采集来自传感器的小车与摆杆的实际位置信号,与期望值进行比较后,通过控制算法得到控制量,再经数模转换驱动直流电机实现倒立摆的实时控制。直流电机通过皮带带动小车在固定的轨道上运动,摆杆的一端安装在小车上,能以此点为轴心使摆杆能在垂直的平面上自由地摆动。作用力u平行于铁轨的方向作用于小车,使杆绕小车上的轴在竖直平面内旋转,小车沿着水平铁轨运动。当没有作用力时,摆杆处于垂直的稳定的平衡位置(竖直向下)。为了使杆子摆动或者达到竖直向上的稳定,需要给小车一个控制力,使其在轨道上被往前或朝后拉动。 倒立摆系统简介 倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。最初研究开始于二十世纪50 年代,麻省理工学院(MIT)的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。近年来,新的控制方法不断出现,人们试图通过倒立摆这样一个典型的控制对象,检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力,从而从中找出最优秀的控制方法。倒立摆系统作为控制理论研究中的一种比较理想的实验手段,为自动控制理论的教学、实验和科研构建一个良好的实验平台,以用来检验某种控制理论或方法的典型方案,促进了控制系统新理论、新思想的发展。由于控制理论的广泛应用,由此系统研究产生的方法和技术将在半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截控制系统、航空对接控制技术、火箭发射中的垂直度控制、卫星飞行中的姿态控制和一般工业应用等方面具有广阔的利用开发前景。平面倒立摆可以比较真实的模拟火箭的飞行控制和步行机器人的稳定控制等方面的研究。 倒立摆分类

一级倒立摆地Simulink仿真

单级倒立摆稳定控制 直线一级倒立摆系统在忽略了空气阻力及各种摩擦之后,可抽象成小车和匀质摆杆组成的系统,如图1所示。 图1 直线一级倒立摆系统 图2 控制系统结构 假设小车质量M =0.5kg ,匀质摆杆质量m=0.2kg ,摆杆长度2l =0.6m ,x (t )为小车的水平位移,θ为摆杆的角位移,2 /8.9s m g =。控制的目标是通过外力u (t)使得摆直立向上(即0)(=t θ)。该系统的非线性模型为: u ml x m M ml mgl x ml ml J +=++=++22)sin ()()cos (sin )cos ()(θθθθθθθ ,其中231ml J =。 解: 一、 非线性模型线性化及建立状态空间模型 因为在工作点附近(0,0==θ θ )对系统进行线性化,所以 可以做如下线性化处理:32 sin ,cos 13!2!θθθθθ≈-≈-

当θ很小时,由cos θ、sin θ的幂级数展开式可知,忽略高次项后, 可得cos θ≈1,sin θ≈θ,θ’^2≈0; 因此模型线性化后如下: (J+ml^2)θ’’+mlx ’’=mgl θ (a) ml θ’’+(M+m) x ’’=u (b) 其中23 1ml J = 取系统的状态变量为,,,,4321θθ ====x x x x x x 输出T x y ][θ=包括小车位移和摆杆的角位移. 即X=????????????4321x x x x =????? ???????''θθx x Y=??????θx =??????31x x 由线性化后运动方程组得 X1’=x ’=x2 x2’=x ’’=m m M mg 3)(43-+-x3+m m M 3)(44-+u X3’ =θ’=x4 x4’=θ’’=ml l m M g m M 3)(4)(3-++x3+ml l m M 3)(43-+-u 故空间状态方程如下: X ’=????????????'4'3'2'1x x x x =????????????????? ?-++-+-03)(4)(300100003)(4300 0010ml l m M g m M m m M mg ????????????4321x x x x + ???????? ??????????-+--+ml l m M m m M 3)(4303)(440 u

倒立摆建模

系统建模 系统建模可以分为两种:机理建模和实验建模.实验建模就是通过在研究对象上加上一系列的研究者先确定的输入信号,激励研究对象并通过传感器的检测其可观测的输出,应用数学手段建立起系统输入---输出关系.这里包括输入信号的设计选取,输出信号的精确检测,数学算法的研究等等内容.机理建模就是在了解研究对象在运动规律基础上,通过物理,化学的知识和数学手段建立起的系统内部的输入输出状态关系.系统的建模原则: 1) 建模之前,要全面了解系统的自然特征和运动机理,明确研究目的和准确性要求,选择合适的分析方法。 2) 按照所选分析法,确定相应的数学模型的形式; 3) 根据允许的误差范围,进行准确性考虑,然后建立尽量简化的合理的数学模型。 小车—倒立摆系统是各种控制理论的研究对象。只要一提小车—倒立摆系统,一般均认为其数学模型也已经定型。事实上,小车—倒立摆的数学模型与驱动系统有关,常见到的模型只是对应于直流电机的情况,如果执行机构是交流伺服电机,就不是这个模型了。本文主要分析由直流电机驱动的小车—倒立摆系统。小车倒立摆系统是检验控制方式好坏的一个典型对象,其特点是高阶次、不稳定、非线性、强耦合,只有采取有效的控制方式才能稳定控制. 在忽略空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车忽然均匀质杆组成的系统,如下图所示: 图中F 是施加于小车的水平方向的作用力,x 是小车的位移,φ是摆的倾斜角。若不给小车施加控制力,倒摆会向左或向右倾斜,控制的目的是当倒摆出现偏角时,在水平方向上给小车以作用力,通过小车的水平运动,使倒摆保持在垂直的位置。即控制系统的状态参数,以保持摆的倒立稳定。 M 小车的质量 0.5Kg m 摆杆的质量 0.2Kg X φ F M 图1 直线一级倒立摆系统 θ

倒立摆系统的建模及Matlab仿真

倒立摆系统的建模及Matlab 仿真 1.系统的物理模型 考虑如图(1)面内运动的二维问题。 图(1)倒立摆系统 假定倒立摆系统的参数如下。 摆杆的质量:m=0.1g 摆杆的长度:l =1m 小车的质量: M=1kg 重力加速度:g=9.8m/2s 摆杆的质量在摆杆的中心。 设计一个控制系统,使得当给定任意初始条件(由干扰引起)时,最大超调量δ ≤10%,调节时 间ts ≤4s ,通过小车的水平运动使倒立摆保持在垂直位置。 2.系统的数学模型 2.1建立倒置摆的运动方程并将其线性化。 为简化问题,在数学模型中首先假设:1)摆杆为刚体;2)忽略摆杆与支点之间的摩擦;3)忽略小车与接触面间的摩擦。 设小车瞬时位置为z,摆心瞬时位置为(θsin l z +),在u 作用下,小车及摆均产生加速远动,根据牛顿第二定律,在水平直线远动方向的惯性力应与u 平衡,于是有 u l z dt d m dt z d M =++)sin (22 22θ 即: u ml ml z m M =-++θθθθsin cos )(2&&&&& ① 绕摆轴转动的惯性力矩与重力矩平衡,因而有

θθθsin cos )sin (22mgl l l z dt d m =??? ????+ 即: θθθθθθθsin cos sin cos cos 22g l l z =-+&&&&& ② 以上两个方程都是非线性方程,为求得解析解,需作线性化处理。由于控制的目的是保持倒立摆直 立,在试驾合适的外力条件下,假定θ很小,接近于零时合理的,则1cos ,sin ≈≈θθθ,且可忽略θ θ2&项。于是有 u ml z m M =++θ&&&& )( ③ θθg l z =+&&&& ④ 联立求解可得 u Ml Ml m M u M M mg z 1)(1 -+=+- =θθθ&&&& 2.2列写系统的状态空间表达式。 选取系统变量4321,,,x x x x , []T x x x x x 4321,,,=则 u Ml x Ml m M x x x u M x M mg x x x 1 )(134433221-+= =+-==&&&& 即 []Cx x x y Bu Ax u Ml M x Ml g m M M mg z z dt d x ===+=?????? ? ???????-+?????????? ??? ? +- =???? ????????=000110100)(0 010 0000000 1 1θθ&&& 代入数据计算得到: [][]0,0001,1010,01100 1000010000 1 0==-=? ? ??? ? ??? ???-=D C B A T

三相变压器建模及仿真及MATLAB仿真

XXXXXXX学院课程设计报告 课程名称: 系部: 专业班级: 学生姓名: 指导教师: 完成时间: 报告成绩: 学院教学工作部制

目录 摘要 (3) 第一章变压器介绍 (4) 1.1 变压器的磁化特性 (4) 1.2 变压器保护 (4) 1.3 励磁涌流 (7) 第二章变压器基本原理 (9) 2.1 变压器工作原理 (9) 2.2 三相变压器的等效电路及联结组 (10) 第三章变压器仿真的方法 (11) 3.1 基于基本励磁曲线的静态模型 (11) 3.2基于暂态磁化特性曲线的动态模型 (13) 3.3非线性时域等效电路模型 (14) 第四章三相变压器的仿真 (16) 4. 1 三相变压器仿真的数学模型 (16) 4.2电源电压的描述 (20) 4.3铁心动态磁化过程简述 (21) 第五章变压器MATLAB仿真研究 (25) 5.1 仿真长线路末端电压升高 (25) 5.2 仿真三相变压器 T2 的励磁涌流 (28) 5.3三相变压器仿真模型图 (34) 5.4 变压器仿真波形分析 (36) 结论 (40) 参考文献 (41)

摘要 在电力变压器差动保护中,励磁涌流和内部故障电流的判别一直是一个关键问题。文章阐述了励磁涌流的产生及其特性,利用 MATLAB 对变压器的励磁涌流、内部故障和外部故障进行仿真,对实验的数据波形分析,以此来区分故障和涌流,目的是减少空载合闸产生的励磁涌流对变压器差动保护的影响,提高保护的灵敏性。 本文在Matlab的编程环境下,分析了当前的变压器仿真的方法。在单相情况下,分析了在饱和和不饱和的励磁涌流现象,和单相励磁涌流的特征。在三相情况下,在用分段拟和加曲线压缩法的基础上,分别用两条修正的反正切函数,和两条修正的反正切函数加上两段模拟饱和情况的直线两种方法建立了Yd11、Ynd11、Yny0和Yy0四种最常用接线方式下三相变压器的数学仿真模型,并在Matlab下仿真实现。通过对三相励磁涌流和磁滞回环波形分析,三相励磁涌流的特征分析,总结出影响三相变压器励磁涌流地主要因素。最后,分析了两种方法的优劣,建立比较完善的变压器仿真模型。 关键字: 变压器;差动保护;励磁涌流;内部故障;外部故障;波形分析;仿真;数学模型

20112515直线一级倒立摆机理建模

上海电力学院课程设计报告 课名:自动控制原理应用实践 题目:倒立摆控制装置 院系:自动化工程学院 专业:测控技术与仪器 班级:2011151班 姓名:马玉林 学号:20112515 时间:2014年1月14日

倒立摆系统按摆杆数量的不同,可分为一级,二级,三级倒立摆等,多级摆的摆杆之间属于自有连接(即无电动机或其他驱动设备)。对倒立摆系统的研究能有效的反映控制中的许多典型问题:如非线性问题、鲁棒性问题、镇定问题、随动问题以及跟踪问题等。通过对倒立摆的控制,用来检验新的控制方法是否有较强的处理非线性和不稳定性问题的能力。 倒立摆的控制问题就是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡和过大的角度和速度。当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。 1.1 倒立摆的控制方法 倒立摆系统的输入来自传感器的小车与摆杆的实际位置信号,与期望值进行比较后,通过控制算法得到控制量,再经数模转换驱动直流电机实现倒立摆的实时控制。直流电机通过皮带带动小车在固定的轨道上运动,摆杆的一端安装在小车上,能以此点为轴心使摆杆能在垂直的平面上自由地摆动。作用力u平行于铁轨的方向作用于小车,使杆绕小车上的轴在竖直平面内旋转,小车沿着水平铁轨运动。当没有作用力时,摆杆处于垂直的稳定的平衡位置(竖直向下)。为了使杆子摆动或者达到竖直向上的稳定,需要给小车一个控制力,使其在轨道上被往前或朝后拉动。 本次设计中我们采用其中的牛顿-欧拉方法建立直线型一级倒立摆系统的数学模型,然后通过开环响应分析对该模型进行分析,并利用学习的古典控制理论和Matlab /Simulink仿真软件对系统进行控制器的设计,主要采用根轨迹法,频域法以及PID(比例-积分-微分)控制器进行模拟控制矫正。 2 直线倒立摆数学模型的建立 直线一级倒立摆由直线运动模块和一级摆体组件组成,是最常见的倒立摆之一,直线倒立摆是在直线运动模块上装有摆体组件,直线运动模块有一个自由度,小车可以沿导轨水平运动,在小车上装载不同的摆体组件。 系统建模可以分为两种:机理建模和实验建模。实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号,激励研究对象并通过传感器检测其可观测的输出,应用数学手段建立起系统的输入-输出关系。这里面包括输入

一级倒立摆物理建模、传递函数和状态方程的推导

一级倒立摆物理建模和传递函数的推导 设定: M 小车质量 m 摆杆质量 b 小车摩擦系数 l 摆杆转动轴心到杆质心的长度 I 摆杆惯量 F 加在小车上的力 x 车位置 φ 摆杆与垂直向上方向的夹角

图1、2是系统中小车和摆杆的受力分析图。其中,N 和P 为小车与摆杆相互作用。 分析小车水平方向所受的合力,可以得到以下方程: N x b F x M --=? ?? (1) 由摆杆水平方向的受力进行分析可以得到下面等式: )sin (22 θl x dt d m N += (2) 即: θθθθsin cos 2 ?? ???-+=ml ml x m N (3) 把这个等式代入式(3)中,就得到系统的第一个运动方程: F ml ml x b x m M =-+++?? ????θθθθsin cos )(2 (4) 对摆杆垂直方向上的合力进行分析,可以得到下面方程: )cos (2 2 θl dt d m mg P =- (5) θθθθcos sin 2 ?? ?--=-ml ml mg P (6) 力矩平衡方程: ? ?=--θθθI Nl Pl cos sin (7)

此方程中力矩的方向,由于φπθ+=,θφcos cos -=,θφsin sin -=,故等式前面有负号。 合并这两个方程,约去 P 和N ,得到第二个运动方程: θ θθcos sin )(2 ? ???-=++x ml mgl ml I (8) 设θ =π +φ, 假设φ 与1(单位是弧度)相比很小,即c <<1,则可以进行近似处理:1cos -=θ,φθ-=sin ,0)(2 =dt d θ。用u 来代表被控对象的输入力F ,线性化后两个运动方程如下: { u ml x b x m M x ml mgl ml I =-++=-+? ?? ? ?? ???φφφ)()(2 (9) 假设初始条件为0,对式(9)进行拉普拉斯变换: { ) ()()()()()()()()(22222s U s s ml s s bX s s X l M s s mlX s mgl s s ml I =Φ-++=Φ-Φ+ (10) 由于输出为角度φ ,求解方程组的第一个方程,可以得到: )(])([)(22s s g ml ml I s X Φ-+= (11) 或 mgl s ml I mls s X s -+=Φ2 22)()()( (12) 令? ?=x v ,则有: mgl s ml I ml s V s -+=Φ22)()()( (13) 把上式代入方程组的第二个方程,得到:

倒立摆仿真报告

计算机控制系统课题报告 1.倒立摆基本背景: 倒立摆,Inverted Pendulum ,是典型的多变量、高阶次,非线性、强耦合、自然不稳定系统。倒立摆系统的稳定控制是控制理论中的典型问题,在倒立摆的控制过程中能有效反映控制理论中的许多关键问题,如非线性问题、鲁棒性问题、随动问题、镇定、跟踪问题等。因此倒立摆系统作为控制理论教学与科研中典型的物理模型,常被用来检验新的控制理论和算法的正确性及其在实际应用中的有效性。从 20 世纪 60 年代开始,各国的专家学者对倒立摆系统进行了不懈的研究和探索。 倒立摆系统按摆杆数量的不同,可分为一级,二级,三级倒立摆等,多级摆的摆杆之间属于自由连接(即无电动机或其他驱动设备)。由中国的大连理工大学李洪兴教授领导的“模糊系统与模糊信息研究中心”暨复杂系统智能控制实验室采用变论域自适应模糊控制成功地实现了四级倒立摆。因此,中国是世界上第一个成功完成四级倒立摆实验的国家。 倒立摆的控制问题就是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡和过大的角度和速度。当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。 2.倒立摆模型分析 倒立摆系统的输入为小车的位移(即位置)和摆杆的倾斜角度期望值,计算机在每一个采样周期中采集来自传感器的小车与摆杆的实际位置信号,与期望值进行比较后,通过控制算法得到控制量,再经数模转换驱动直流电机实现倒立摆的实时控制。直流电机通过皮带带动小车在固定的轨道上运动,摆杆的一端安装在小车上,能以此点为轴心使摆杆能在垂直的平面上自由地摆动。作用力F平行

于铁轨的方向作用于小车,使杆绕小车上的轴在竖直平面内旋转,小车沿着水平铁轨运动。当没有作用力时,摆杆处于垂直的稳定的平衡位置(竖直向下)。为了使杆子摆动或者达到竖直向上的稳定,需要给小车一个控制力,使其在轨道上被往前或朝后拉动。 我们的分析对象是一阶倒立摆。很多国内实验都说可以合理的假设空气阻力为0,但查阅了更多的文献和真正仿真做出模型并在网络上开源的一些实验后,我认为这是不正确的。空气阻力或许可以忽略,但是对于运动过程中的所有阻碍都忽略那就太为理想。也就是说,我们需要自己假设一个阻碍模型,即收到的所有阻力等效成一个包含速度,位姿等的广义函数。当然,我们的时间精力和所学知识都还有限,却也不想太过简单。我选取了一个阻力和速度成正比的函数关系,来在以后的建模和仿真过程中来模拟倒立摆所受的一切阻碍。 3.1 倒立摆物理建模:基于经典牛顿力学 受力分析如上图。 那我们在本实验中定义如下变量: M 小车质量 m 摆杆质量 b 小车摩擦系数 l 摆杆转动轴心到杆质心的长度(0.3 m)

四旋翼飞行器建模与仿真Matlab

四轴飞行器的建模与仿真 摘要 四旋翼飞行器是一种能够垂直起降的多旋翼飞行器,它非常适合近地侦察、监视的任务,具有广泛的军事和民事应用前景。本文根据对四旋翼飞行器的机架结构和动力学特性做详尽的分析和研究,在此基础上建立四旋翼飞行器的动力学模型。四旋翼飞行器有各种的运行状态,比如:爬升、下降、悬停、滚转运动、俯仰运动、偏航运动等。本文采用动力学模型来描述四旋翼飞行器的飞行姿态。在上述研究和分析的基础上,进行飞行器的建模。动力学建模是通过对飞行器的飞行原理和各种运动状态下的受力关系以及参考牛顿-欧拉模型建立的仿真模型,模型建立后在Matlab/simulink软件中进行仿真。 关键字:四旋翼飞行器,动力学模型,Matlab/simulink Modeling and Simulating for a quad-rotor aircraft ABSTRACT The quad-rotor is a VTOL multi-rotor aircraft. It is very fit for the kind of reconnaissance mission and monitoring task of near-Earth, so it can be used in a wide range of military and civilian applications. In the dissertation, the detailed analysis and research on the rack structure and dynamic characteristics of the laboratory four-rotor aircraft is showed in the dissertation. The dynamic model of the four-rotor aircraft areestablished. It also studies on the force in the four-rotor aircraft flight principles and course of the campaign to make the research and analysis. The four-rotor aircraft has many operating status, such as climbing, downing, hovering and rolling movement, pitching movement and yawing movement. The dynamic model is used to describe the four-rotor aircraft in flight in the dissertation. On the basis of the above analysis, modeling of the aircraft can be made. Dynamics modeling is to build models under the principles of flight of the aircraft and a variety of state of motion, and Newton - Euler model with reference to the four-rotor aircraft.Then the simulation is done in the software of Matlab/simulink. Keywords: Quad-rotor,The dynamic mode, Matlab/simulink

自动化实验-倒立摆实验-附仿真结果图复习课程

一、直线一级倒立摆的仿真 (一)直线一级倒立摆的数学建模 对于倒立摆系统,由于其本身是自不稳定的系统,实验建模存在一定的困难。但是忽略掉一些次要的因素后,倒立摆系统就是一个典型的运动的刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。下面我们采用其中的牛顿-欧拉方法和拉格朗日方法分别建立直线型一级倒立摆系统的数学模型。 图2 直线一级倒立摆模型 φ摆杆与垂直向上方向的夹角; θ摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)。 图3 小车及摆杆受力分析 分析小车水平方向所受的合力,可以得到以下方程: 由摆杆水平方向的受力进行分析可以得到下面等式:

把这个等式代入式1中,就得到系统的第一个运动方程: 为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得到下面方程: 力矩平衡方程如下: 注意:此方程中力矩的方向,由于θ=π+φ,cosφ= ?cosθ,sinφ= ?sinθ,故等式前面有负号。 合并这两个方程,约去P 和N,得到第二个运动方程: 设θ=π+φ(φ是摆杆与垂直向上方向之间的夹角),假设φ与1(单位是弧度)相比很小,即φ<<1,则可以进行近似处理: 。 用u 来代表被控对象的输入力F,线性化后两个运动方程如下: 对式9进行拉普拉斯变换,得到 注意:推导传递函数时假设初始条件为0。 由于输出为角度φ,求解方程组的第一个方程,可以得到:

或 如果令v = x,则有: 把上式代入方程组的第二个方程,得到: 整理后得到传递函数: 其中 设系统状态空间方程为: 方程组对解代数方程,得到解如下: 整理后得到系统状态空间方程:

一级倒立摆MATLAB仿真、能控能观性分析、数学模型、极点配置

题目一: 考虑如图所示的倒立摆系统。图中,倒立摆安装在一个小车上。这里仅考虑倒立摆在图面内运动的二维问题。倒立摆系统的参数包括:摆杆的质量(摆杆的质量在摆杆中心)、摆杆的长度、小车的质量、摆杆惯量等。 图倒立摆系统 设计一个控制系统,使得当给定任意初始条件(由干扰引起)时,最大超调量 %≤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)

(完整版)倒立摆建模

1.一阶倒立摆建模 在忽略了空气流动阻力,以及各种摩擦之后,可将倒立摆系统抽象成小车和匀质杆组成的系统,如下图所示,其中: M :小车质量 m :为摆杆质量 J :为摆杆惯量 F :加在小车上的力 x :小车位置 θ:摆杆与垂直向上方向的夹角 l :摆杆转动轴心到杆质心的长度 根据牛顿运动定律以及刚体运动规律,可知: (1) 摆杆绕其重心的转动方程为 (2) 摆杆重心的运动方程为 得 (3)小车水平方向上的运动为 22..........(4)x d x F F M d t -= 联列上述4个方程,可以得出 一阶倒立精确气模型: ()()()()()()()2222222222222222 sin .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 θθθθθθθθθθθθ?+++-?= ++-??+-+?=?-++? &&&&&& sin cos ..........(1)y x J F l F l θθθ=-& &2 22 2(sin ) (2) (cos ).........(3)x y d F m x l d t d F mg m l d t θθ=+=-

式中J 为摆杆的转动惯量:3 2 ml 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 θθθ 2.2 模型建立及封装 1、建立以下模型:

相关文档
最新文档