一级倒立摆物理建模、传递函数和状态方程的推导
一级倒立摆物理建模和传递函数的推导
设定:
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) 把上式代入方程组的第二个方程,得到:
)()()(])([)(])()[(22222
2s U s s ml s s s
g ml ml I b s s s g ml ml I m M =Φ-Φ+++Φ-++ (14)
整理后得到传递函数:
q
bmgl
s q mgl m M s q ml I b s s
q
ml
s U s -
+++=Φ2223)()()()( (15) 其中 ])())([(22ml ml I m M q -++=。
系统物理参数: M
小车质量
1.096Kg m 摆杆质量
0.109Kg b 小车摩擦系数
0.1N/m/sec l 摆杆转动轴心到杆质心的长度 0.25m
I
摆杆惯量
0.0034Kg*m*m
设系统状态空间方程为:
Du
CX Y Bu AX X +=+=•
对•
•x ,•
•φ解代数方程,得到解如下:
⎪⎪⎪⎪⎭
⎪
⎪⎪⎪⎬⎫⎪⎪⎪
⎪⎩
⎪⎪⎪⎪⎨⎧++++++-==+++++++-=
=••
••••••••u Mml m M I ml Mml m M I m M mg x Mml m M I mlb u Mml m M I ml I Mml m M I gl m x Mml m M I b ml I x x x 2222222222)()()()()()
()()()(φφφφφ (17) 整理后得到系统状态空间方程:
⎥⎥⎥⎥⎥⎥
⎦
⎤
⎢⎢⎢⎢⎢⎢⎣⎡++++⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣
⎡+++-+++-=⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡••••••••2222
2
2
2
2
2
2)(0)()(00)()()(010
000)()()(0001
Mml m M I ml Mml m M I ml I x x Mml m M I m M mg Mml m M I mlb Mml m M I gl m Mml m M I b ml I x x φφφφu u x x x y ⎥⎦⎤
⎢⎣⎡+⎥⎥⎥⎥⎥
⎦
⎤⎢⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢
⎣⎡=⎥⎦⎤⎢⎣⎡=••0001
00
0001
φφφ (18)
对于质量均匀分布的摆杆有: 23
1
ml I =,由(9)的第一个方程
•
••
•=-+x ml mgl ml I φφ)(2
,可得到:
)31(2
2ml ml +••φ- mgl ml =φ••x 化简:
•
•φ=l
l g 4343+φ•
•x
(19)
设X=,,,,⎭
⎬⎫⎩⎨⎧••φφx x '
u =•
•x ,有:
'430100430
0100
000000010
u l x x l g x x ⎥⎥⎥⎥⎥⎦
⎤⎢⎢⎢⎢⎢⎣⎡+⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣
⎡=⎥⎥⎥⎥⎥
⎦⎤⎢⎢⎢⎢⎢⎣⎡••••••••φφφφ
'
0001000001u x x x y ⎥⎦
⎤⎢⎣⎡+⎥⎥⎥⎥⎥
⎦
⎤⎢⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=••φφφ (20)
THANKS !!!
致力为企业和个人提供合同协议,策划案计划书,学习课件等等
打造全网一站式需求
欢迎您的下载,资料仅供参考。
(完整版)一级倒立摆系统分析
一级倒立摆的系统分析一、倒立摆系统的模型建立如图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)以上公式推理是根据牛顿力学的微分方程验证的。
一级倒立摆的建模及控制分析
直线一级倒立摆的建模及控制分析摘要:本文利用牛顿—欧拉方法,建立了直线型一级倒立摆系统的数学模型。
在分析的基础上, 采用状态反馈控制中极点配置法设计了用于直线型一级倒立摆系统的控制器。
此外,用MATLAB 仿真绘制了相应的曲线并做了分析。
一、问题描述倒立摆控制系统是机器人技术、控制理论、计算机控制等多个领域和多种技术的有机结合,其被控系统本身是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,是控制理论研究中较为理想的实验对象。
它为控制理论的教学、实验和科研构建了一个良好的实验平台,促进了控制系统新理论、新思想的发展。
倒立摆系统可以采用多种理论和方法来实现其稳定控制,如PID,自适应、状态反馈、智能控制等方法都己经在倒立摆控制系统上得到实现。
由于直线一级倒立摆的力学模型较简单,又是研究其他倒立摆的基础,所以本文利用所学的矩阵论知识对此倒立摆进行建模和控制分析。
二、方法简述本文利用牛顿—欧拉方法,建立了直线型一级倒立摆系统的数学模型。
在分析的基础上, 采用状态反馈控制中极点配置法设计了用于直线型一级倒立摆系统的控制器。
此外,用MATLAB 仿真绘制了相应的曲线并做了分析。
三、模型的建立及分析3.1 微分方程的推导在忽略了空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如下图1所示。
图1 直线一级倒立摆系统假设 M 为小车质量;m 为摆杆质量;b 为小车摩擦系数;l 为摆杆转动轴心到杆质心的长度;I 为摆杆惯量;F 为加在小车上的力;x 为小车位置;φ为摆杆与垂直向上方向的夹角;θ为摆杆与垂直向下方向的夹角。
图2是系统中小车和摆杆的受力分析图。
其中,N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量。
值得注意的是: 在实际倒立摆系统中检测和执行装置的正负方向已确定, 因而矢量方向定义如图2所示, 图示方向为矢量正向。
(a) (b)图2 小车和摆杆的受力分析图分析小车水平方向所受的合力,可以得到以下方程:N x b F x M --= (1)由摆杆水平方向的受力进行分析可以得到下面等式:θθθθs i n c o s 2ml ml x m N -+= (2) 把这个等式代入上式中,就得到系统的第一个运动方程:()F ml ml x b x m M =-+++θθθθsin cos 2 (3)为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得到下面方程:θθθθc o s s i n 2 ml ml mg P --=- (4) 力矩平衡方程如下:θθθI Nl Pl =--cos sin (5)合并这(4)、(5)两个方程,约去P 和N ,得到第二个运动方程:()θθθc o s s i n 2x ml mgl ml I -=++ (6) 假设φ与1(单位是弧度)相比很小,即φ《1,则可以进行近似处理:0d d s i n 1c o s 2=⎪⎭⎫ ⎝⎛-=-=t θφθθ,, (7) 用u 来代表被控对象的输入力F ,线性化后两个运动方程如下:()()⎩⎨⎧=-++=-+u ml x b x m M xml mgl ml I φφφ 2 (8) 3.2 状态空间方程方程组(8)对φ,x 解代数方程,整理后的系统状态空间方程为: ()()()()()()()()u Mm l m M I m l Mm l m M I m lI x x Mm l m M I m M m gl Mm l m M I m lbMm l m M I gl m Mm l m M I b m l I x x ⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡++++++⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡+++++-+++++-=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡222222222200001000000010φφφφ u x x x y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=0001000001φφφ 对于质量均匀分布的摆杆有:3/2ml I =,于是可得:()x ml mgl ml ml =-+φφ223/ 化简得:xll g 4343+=φφ设}{x u x x X ==1,,,,φφ ,则有:14301004300100000000010u l x x l g x x⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡φφφφ10001000001u x x x y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=φφφ 3.3 实际系统模型实际系统模型参数: M =1.096 Kg ;m =0.109 Kg ;b =0.1 N/m/s ; l =0.25 m ;I =0.0034 kg ·m ·m ;采样频率 T =0.005 s 。
倒立摆系统的建模(拉格朗日方程)
系统的建模及性能分析倒立摆系统的构成及其参数1倒立摆系统的基本结构本设计所用到的倒立摆模型直线一级倒立摆系统。
整个系统是由6大部分所组成的一个闭环系统,包括计算机、数据采集卡、电源及功率放大器、直流伺服电机、倒立摆本体和两个光电编码器等模块。
如图2.1所示:图2.1 倒立摆系统的结构组成示意图Fig 2.1 Structure of the linear single inverted pendulum system2系统主要组成部分简介直线一级倒立摆装置如图2.2所示[13]:图2.2直线一级倒立摆装置Fig 2.2 Straight linear 1-stage inverted pendulum device Quanser倒立摆系统包含倒立摆本体、数据采集电控模块以及控制平台等三大部分,其中控制平台是由装有Quanser专用实时控制软件的通用PC机组成。
1.直线倒立摆主体倒立摆主体是由Quanser直线运动控制伺服单元IP02与直线一级摆杆组成,并配有专用的小车直线轨道。
这里主要介绍下Quanser直线运动控制伺服单元IP02(即倒立摆运动小车)及导轨的组成:图2.3伺服单元IP02的组成Fig 2.3 Servo unit IP02 parts编号名称英文(01)IP02小车IP02 Cart(02)不锈钢滑轨Stainless Steel Shaft(03)齿轮导轨Rack(04)小车位移齿轮Cart Position Pinion(05)小车电机传动齿轮Cart Motor Pinion(06)小车电机传动齿轮轴Cart Motor Pinion Shaft(07)摆杆传动轴Pendulum Axis(08)IP02小车位移编码器IP02 Cart Encoder(09)IP02摆杆角度编码器IP02 Pendulum Encoder(10)IP02小车位移编码器接口IP02 Cart Encoder Connector(11)IP02摆杆角度编码器接口IP02 Pendulum Encoder Connector(12)电机接口Motor Connector(13)直流伺服电机DC Motor(14)变速器Planetary Gearbox(15)直线滑轨支撑轴Linear Bearing(16)摆杆连接套Pendulum Socket(17)IP02配重模块IP02 Weight图2.4系统导轨结构图Fig 2.4 System guide rail structure编号名称英文(22)导轨末端挡板Rack End Plate(23)导轨固定螺丝Rack Set Screw(24)小车运动限位Track Discontinuity直线一级倒立摆系统的倒立摆的摆杆连接在IP02小车的摆杆连接套上,IP02小车由电机通过齿轮传动机构在导轨上来回运动,保持摆杆平衡。
一级直线倒立摆系统模糊控制器设计---实验指导书精讲
一级直线倒立摆系统模糊控制器设计---实验指导书精讲第一篇:一级直线倒立摆系统模糊控制器设计---实验指导书精讲一级直线倒立摆系统模糊控制器设计实验指导书目录实验要求........................................................................................................................... ...................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 实验准备实验准备是顺利完成实验内容的必要条件。
哈工大一阶倒立摆
2.1
倒立摆系统其本身是自不稳定系统,实验建模存在一些问题和困难,在忽略掉一些次要的因素后,倒立摆系统是一个典型的运动的刚体系统,可以再惯性坐标系中运用经典力学对它进行分析,来建立系统动力学方程。
在忽略掉了空气阻力和各种摩擦力之后,可以讲一阶倒立摆系统抽象成小车和均匀杆组成的系统,一阶倒立摆系统的结构示意图如下:
四预防和控制轰燃的灭火救援对策一全面侦查火情注意轰燃征兆在处置建筑室内火灾时应全面侦查火情快速掌握起火房间位置火势大小人员被困情况室内可燃物数量与类别建筑结构特点周围毗邻建筑情况等尤其对于通风不好且室内可燃物数量较多时应提高警惕密切监视谨防轰燃突发造成恶性事故
哈尔滨工业大学
控制科学与工程系
控制系统设计课程设计报告
(2-8)
微分方程的建立:
因为 ,假设φ<<1弧度,则可以进行近似处理: 来实现线性化。
用上述近似进行线性化得直线一阶倒立摆的微分方程为:
一阶倒立摆的传递函数模型:
对上式进行拉普拉斯变换,得:
推导传递函数时假设初始条件为0。
由于输出为角度φ,求解方程组的第一个方程,可得:
或
如果令 ,则有:
把上式代入方程组(2-1)的第二个方程,得:
该系统的输出为
其中: num——被控对象传递函数的分子项
den——被控对象传递函数的分母项
numPID——PID控制器传递函数的分子项
denPID——PID控制器传递函数的分母项
通过分析上式就可以得到系统的各项性能。
由(2-13)可以得到摆杆角度和小车加速度的传递函数:
PID控制器的传递函数为:
只需调节PID控制器的参数,就可以得到满意的控制效果。
直线一级倒立摆的建模及性能分析
直线一级倒立摆的建模及性能分析1 直线一级倒立摆数学模型的建立 (1)2 直线一级倒立摆系统的实际模型 (5)3 直线一级倒立摆系统的性能分析 (6)相关理论的介绍 (6)倒立摆系统的性能分析 (7)1 直线一级倒立摆数学模型的建立所谓系统的数学模型,是指利用数学结构来反映实际系统内部之间、系统内部与外部某些主要相关因素之间的精确的定量表示。
数学模型是分析、设计、预测以及控制一个系统的理论基础。
因此,对于实际系统的数学模型的建立就显得尤为重要。
系统数学模型的构建可以分为两种:实验建模和机理建模。
实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号,激励研究对像并通过传感器检测其可观测的输出,应用数学手段建立起系统的输入-输出关系。
机理建模就是在了解研究对象的运动规律的基础上,通过物理、化学的知识和数学手段建立起系统内部的输入-状态关系。
对于倒立摆系统,由于其本身是不稳定的系统,无法通过测量频率特性的方法获取其数学模型,实验建模存在一定的困难。
但是经过小心的假设忽略掉一些次要的因素后,倒立摆系统是一个典型的机电一体化系统,其机械部分遵守牛顿运动定律,其电子部分遵守电磁学的基本定律,因此可以通过机理建模得到系统较为精确的数学模型。
为了简单起见,在建模时忽略系统中的一些次要的难以建模的因素,例如空气阻力、伺服电机由于安装而产生的静摩擦力、系统连接处的松弛程度、摆杆连接处质量分布不均匀、传动皮带的弹性、传动齿轮的间隙等。
将小车抽象为质点,摆杆抽象为匀质刚体,摆杆绕转轴转动,这样就可以通过力学原理建立较为精确的数学模型。
我们可以应用牛顿力学的分析方法或者欧拉-拉格朗日原理建立系统的动力学模型。
对于直线一级倒立摆这样比较简单的系统,我们采用通俗易懂的牛顿力学分析法建模。
为了建立直线一级倒立摆的数学模型,采用如下的坐标系:图1直线一级倒立摆的物理模型其中,F 为加在小车上的力,M 为小车质量,m 为摆杆质量,I 为摆杆惯量, l 为摆杆转动轴心到杆质心的长度,x 为小车位移,φ为摆杆与垂直向上方向的夹角,b 为小车在滑轨上所受的摩擦力,N 和P 为摆杆相互作用力的水平和垂直方向的分量。
一级倒立摆的可视化建模与稳定控制设计
1966年
1976年
1995年
倒立摆的应用
倒立摆的分类
直线倒立摆 一级倒立摆
基座运动
环形倒立摆
摆杆
二级倒立摆
平面倒立摆
多级倒立摆
另外根据材料分类:刚体摆杆倒立摆系统和柔性摆杆倒立摆系统 „„
根据不同的分类方法,我们可以将倒立摆进行不同的分类。
倒立摆的特点
特性:非线性、多变量、强耦合、不稳定性
倒立摆系统拥有低投入、简易的结构、直观 的形象、方便仿真等特点。
设计演示界面
保存文件,命名为 fangzhenjieguo.fig ,同时会自动生成一 个fangzhenjieguo.m 文件
将摆角、小车位 移和时间参量, 导入到工作区中 ,供GUI编程使 用。
打开之前保存演示界面是生成的fangzhenjieguo.m文件,找到 “仿真开始”按钮所对应的回调函数,在函数下方加入程序: sim('daolibaimoxing');%运行仿真模型
初始条件设为[0.1rad,0.5rad/s,0,0],仿真曲线如 图所示,上面图线为摆角,下面为小车位移。
右图为未加控制器前的系统 阶跃响应曲线,可以看出, 摆角和小车位移的曲线都是 发散的。通过与仿真结果比 较,可以看出,加了BP神经 网络控制器的倒立摆系统, 摆角和小车位移曲线趋于稳 定,说明所设计的BP神经网 络控制器能够起到有效的控 制作用。验证了控制器设计 的正确性和可行性。
四、GUI设计
图形用户界面(Graphical User Interface, 简称 GUI,又称图形用户接口)是指采用图形 方式显示的计算机操作用户界面。
GUI具有下面几个方面的基本要求:轻型、 占用资源少、高性能、高可靠性、便于移 植、可配置等特点。
直线一级倒立摆的牛顿—欧拉方法建模
直线一级倒立摆的牛顿—欧拉方法建模首先,我们需要定义系统的坐标和状态变量。
在这个问题中,我们可以选择将质点的位置和角度作为系统的状态。
令x表示质点的水平位置,θ表示摆杆与竖直方向的夹角。
其次,我们需要确定系统的动力学方程。
根据牛顿第二定律和欧拉定理,可以得到如下的动力学方程:m * x'' = -m * g * sin(θ) - c * x';I * θ'' = m * g * cos(θ) * L - J * θ'其中,m是质点的质量,g是重力加速度,c是摩擦系数,L是摆杆的长度,I是质点关于摆杆固定点的转动惯量,J是摆杆的转动惯量。
最后,我们可以采用数值方法来求解这个动力学方程。
牛顿-欧拉方法是一种常用的数值方法,它基于一阶泰勒级数展开近似,并使用离散时间步长来进行数值计算。
具体步骤如下:1.将时间t离散化为n个时间步长Δt的序列:t_0,t_1,...,t_n。
2.初始化系统的状态变量:x(0),θ(0),x'(0),θ'(0)。
3.对于每个时间步长i,计算状态变量的更新:a. 计算加速度:x''(i) = (1/m) * (-m * g * sin(θ(i)) - c * x'(i))θ''(i) = (1/I) * (m * g * cos(θ(i)) * L - J * θ'(i))b.使用泰勒级数展开逼近位置和速度:x(i+1)=x(i)+Δt*x'(i)+0.5*Δt^2*x''(i)θ(i+1)=θ(i)+Δt*θ'(i)+0.5*Δt^2*θ''(i)c.使用泰勒级数展开逼近速度和加速度:x'(i+1)=x'(i)+Δt*x''(i)θ'(i+1)=θ'(i)+Δt*θ''(i)d.根据实际情况对状态进行调整,如质点位置不能超过摆杆范围等。
直线一级倒立摆控制器设计(自动控制理论课程设计)
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课程设计说明书(论文)课程名称:自动控制理论课程设计设计题目:直线一级倒立摆控制器设计院系:电气工程及其自动化学院班级:设计者:学号:指导教师:**哈尔滨工业大学哈尔滨工业大学课程设计任务书*注:此任务书由课程设计指导教师填写。
1、理论模型建立和分析1.1直线一级倒立摆数学模型的推导对于忽略空气阻力和各种摩擦之后,直线一级倒立摆系统抽象为小车和匀质杆组成的系统。
xbp图1-1 倒立摆系统小车和摆杆的受力分析本系统参数定义如下:M——小车质量;m——摆杆质量。
b——小车摩擦系数;l——摆杆转动轴心到杆质心的长度;I——摆杆惯量;F——加在小车上的力;x——小车位置;φ——摆杆与垂直向上方向的夹角。
θ——摆杆与垂直向下方向的夹角方程为:Mx F bx N=--(1-1)因此主动控制力可近似线性化地表示为:()22sin d N m x l dtθ=+ (1-2)即:2cos sin N mx ml ml θθθθ=+- (1-3)代入前面式子:()2cos sin M m x bx ml ml F θθθθ+++-= (1-4)垂直方向上:()22cos d P mg m l dt θ-=- (1-5)即:2sin cos P mg ml ml θθθθ-=+ (1-6) 力矩平衡方程:sin cos Pl Nl I θθθ--= (1-7)注意等式前面的负号,由于,cos cos ,sin sin θπφφθφθ=+=-=-()22sin cos I ml mgl mlxθθθ++=- (1-8)1.微分方程模型 设θπφ=+,近似处理:2cos 1,sin ,()0d dtθθθφ=-=-= 设u=F ,则:()()2M m x bx ml u I ml mgl mlx φφφ⎧++-=⎪⎨+-=⎪⎩ (1-9)2.传递函数模型对上式拉氏变换处理,设初始条件为0,则:()()22222()()()()()()()M m X s s bX s ml s s U s I ml s s mgl s mlX s s ⎧++-Φ=⎪⎨+Φ-Φ=⎪⎩(1-10) 输出为角度为φ,由第二式得到()22()()I ml g X s s ml s ⎡⎤+⎢⎥=-Φ⎢⎥⎣⎦ (1-11)或者()222()()s mls X s I ml s mglΦ=+- (1-12)如果令x ν=,则有()22()()s mlV s I ml s mglΦ=+- (1-13)把上式代入10式,则有:()()()22222()()()()I ml I ml g g M m s s b s s ml s s U s ml s ml s ⎡⎤⎡⎤++⎢⎥⎢⎥+-Φ++Φ-Φ=⎢⎥⎢⎥⎣⎦⎣⎦(1-14)整理:()()212432()()()ml s s q G s U s b I ml M m mgl bmgl s s s sqqqΦ==+++--(1-15)其中()()()22q M m I ml ml ⎡⎤=++-⎣⎦从而,有()()()()()222222432222432()()()()()X s s G s s U s ml s I ml s mglq mlsb I ml M m mgl bmgl s s s s qqqI ml mgls q q b I ml M m mgl bmgl s s s sqqqΦ=⨯Φ+-=⨯+++--+-=+++--(1-16)3.状态空间数学模型X AX BuY CX Du=+=+,可得状态方程()()()()()()()()()2222222222x x I ml b I ml m gl x x u I M m Mml I M m Mml I M m Mml mgl M m mlb ml x u I M m Mml I M m Mml I M m Mml φφφφφ=⎧⎪-++⎪=++⎪++++++⎪⎨=⎪⎪+-⎪=++⎪++++++⎩()()()()()()()()()22222222220100000000100010000010x x I ml b I ml m gl x x I M m Mml I M m Mml I M m Mml u mlb mgl M m ml I M m Mml I M m Mml I M m Mmlx y φφφφφ-++++++++=+-+++++++==⎡⎤⎡⎤⎢⎥⎢⎥⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎢⎥⎢⎥⎣⎦⎣⎦⎡⎤⎡⎤⎢⎥⎢⎣⎦⎣⎦00x x uφφ+⎧⎪⎪⎪⎪⎪⎪⎨⎪⎪⎡⎤⎪⎢⎥⎡⎤⎪⎢⎥⎥⎢⎥⎪⎢⎥⎣⎦⎪⎢⎥⎩⎣⎦1.2系统阶跃响应分析1.2.1、阶跃响应源程序:参考模型 %实际系统参数M=0.5; m=0.2; b=0.1; l=0.3; I=0.006; g=9.8; T=0.005;%求传递函数gs(输出为摆杆角度)和gspo(输出为小车位置)q=(M+m)*(I+m*l^2)-(m*l)^2; num=[m*l/q 0];den=[1 b*(I+m*l^2)/q -(M+m)*m*g*l/q -b*m*g*l/q]; gs=tf(num,den);numpo=[(I+m*l^2)/q 0 -m*g*l/q];denpo=[1 b*(I+m*l^2)/q -(M+m)*m*g*l/q -b*m*g*l/q 0]; gspo=tf(numpo,denpo);%求状态空间sys(A,B,C,D)p=I*(M+m)+M*m*l^2;A=[0 1 0 0;0 -(I+m*l^2)*b/p m^2*g*l^2/p 0;0 0 0 1;0 -m*b*l/p m*g*l*(M+m)/p 0]; B=[0;(I+m*l^2)/p;0;m*l/p]; C=[1 0 0 0;0 0 1 0]; D=0;sys=ss(A,B,C,D);%通过传递函数求系统(摆杆角度和小车位置)的开环阶越响应t=0:T:5; y1=step(gs,t); y2=step(gspo,t); figure(1);plot(t,y2,'b',t,y1,'r'); axis([0 2.5 0 80]);legend('Car Position','Pendulum Angle'); 1.2.2、仿真结果:通过传递函数求系统(摆杆角度和小车位置)的开环阶越响应01020304050607080图1-2 摆杆和小车位置的开环阶跃响应注:左边红色代表小车位置,右边蓝色代表摆杆角度响应。
倒立摆系统传递函数
倒立摆系统传递函数倒立摆是一种具有稳定性能的控制系统,在机械控制领域有着广泛的应用。
通过分析倒立摆系统的传递函数,我们可以深入理解其控制原理和性能特征。
本文将详细介绍倒立摆系统的传递函数推导过程,并讨论其在控制系统设计中的应用。
一、倒立摆系统简介倒立摆系统是由一个悬挂在水平轴上的杆和一个连接在杆上的质量球组成的。
质量球可以在水平面上任意移动,而杆可以绕轴旋转。
倒立摆系统的目标是通过控制杆的角度,使得质量球保持在竖直上方,即使受到外部干扰或扰动。
二、传递函数推导为了推导倒立摆系统的传递函数,我们首先需要建立该系统的动力学模型。
假设杆的质量和摩擦忽略不计,可以得到如下动力学方程:I*θ'' = -m*g*l*sin(θ) + u*l*cos(θ)其中,I代表杆的转动惯量,θ为杆的角度,m为质量球的质量,g 为重力加速度,l为杆的长度,u为施加在杆上的控制力。
为了简化计算,在小角度范围内可以将θ近似为sin(θ),则上述方程可以简化为:I*θ'' = -m*g*l*θ + u*l通过拉普拉斯变换,将上述微分方程转换为频域方程,得到传递函数的表达式:θ(s)/u(s) = 1/(s²*(I/(m*l²) - g/l))其中,s代表复频域变量,θ(s)和u(s)分别为角度和控制力的拉普拉斯变换。
三、传递函数分析为了更好地理解倒立摆系统的控制特性,我们可以对传递函数进行分析。
根据传递函数的表达式可以得知:1. 角度响应:传递函数的分母具有二阶特性,可以通过控制分母的根来调节系统的阻尼比、自然频率和超调量。
较大的阻尼比可以使系统的响应较为平缓,较小的阻尼比则容易产生震荡。
自然频率决定了系统的快速响应能力,较高的自然频率可以使系统更快速地抵消干扰。
超调量则表示系统的阻尼特性,较小的超调量表示系统的稳定性能较好。
2. 稳定性分析:传递函数的分母根的实部均小于零时,系统处于稳定状态。
