精品终稿一级倒立摆.docx
- 文档编号:1302961
- 上传时间:2022-10-20
- 格式:DOCX
- 页数:18
- 大小:448.76KB
精品终稿一级倒立摆.docx
《精品终稿一级倒立摆.docx》由会员分享,可在线阅读,更多相关《精品终稿一级倒立摆.docx(18页珍藏版)》请在冰豆网上搜索。
精品终稿一级倒立摆
1实验设备简介1
1.1倒立摆介绍1
1.2研究倒立摆稳定性的意义2
1.3直线一级倒立摆3
2倒立摆建模3
2.1直线一阶倒立摆数学模型的推导3
2.1.1受力分析4
2.1.2微分方程建模5
2.1.3传递函数建模5
2.1.4状态空间数学模型6
2.2实际系统模型建立8
3系统定性、定量分析9
3.1系统开环阶跃响应9
3.2系统稳定性与可控性分析11
3.2.1稳定性分析11
3.2.2能控性分析12
4设计状态观测器12
4.1状态空间分析12
4.2极点配置的设计步骤13
4.3极点配置的Matlab计算14
4.4极点配置的simulink电路仿真20
4.4.1无状态反馈仿真20
4.4.2有状态反馈的仿真20
4.5极点配置的综合分析21
5小结22
1实验设备简介
1.1倒立摆介绍
倒立摆是处于倒置不稳定状态,人为控制使其处于动态平衡的一种摆。
如杂技演员顶杆的物理机制可简化为一级倒立摆系统,是一个复杂,多变量,存在严重非线性,非自制不稳定系统。
常见的倒立摆一般由小车和摆杆两部分组成,其中摆杆可能是一级,二级或多级,在复杂的倒立摆系统中,摆杆的长度和质量均可变化。
图2:
一级倒立摆系统组成框图
系统是由计算机、运动控制卡、伺服机构、倒立摆本体和光电码盘几大部分组成的闭环系统。
光电码盘1将小车的位移、速度信号反馈给伺服驱动器和运动控制卡,摆杆的角度、角速度信号由光电码盘2反馈给运动控制卡。
计算机从运动控制卡中读取实时数据,确定控制决策(小车运动方向、移动速度、加速度等),并由运动控制卡来实现该控制决策,产生相应的控制量,使电机转动,通过皮带,带动小车运动,保持摆杆平衡。
1.2研究倒立摆稳定性的意义
倒立摆的研究具有重要的工程背景。
机器人行走就类似倒立摆系统从日常生活中所见到的任何重心在上、也是支点在下的控制问题,到空间飞行器和各类伺服云台的稳定,都和倒立摆系统的稳定控制有很大相似性,故对其稳定控制在实际中有很多用场,如海上钻井平台的稳定控制、卫星发射架的稳定控制、火箭姿态控制、飞机安全着陆、化工过程控制等。
1.3直线一级倒立摆
根据自控原理实验书上相关资料,直线一级倒立摆在建模时,一般忽略掉系统中的一些次要因素.例如空气阻力、伺服电机的静摩擦力、系统连接处的松弛程度等,之后可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统。
倒立摆系统是典型的机电一体化系统其机械部分遵循牛顿的力学定律其电气部分遵守电磁学的基本定理.无论哪种类型的倒立摆系统,都具有3个特性,即:
不确定性、耦合性、开环不稳定性.直线型倒立摆系统,是由沿直线导轨运动的小车以及一端固定于小车上的匀质长杆组成的系统.小车可以通过传动装置由交流伺服电机驱动.小车导轨一般有固定的行程,因而小车的运动范围是受到限制的。
2倒立摆建模
2.1直线一阶倒立摆数学模型的推导
对于忽略各种摩擦参数和空气阻力之后,直线一即倒立摆抽象为小车河均质杆组成的系统
本系统的参数定义如下:
M
小车质量(本实验为0.5kg)
m
摆杆质量(本实验为0.2kg)
b
小车摩擦系数(本实验为0.1N/m/sec)
l
摆杆转动轴心到杆质心的长度(本实验为0.3m)
I
摆杆惯量(本实验为0.006kg*m*m)
F
加在小车上的力
x
小车位置(变量)
φ
摆杆与垂直向上方向的夹角(输出)
θ
摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)
2.1.1受力分析
下面我们对这个系统作一下受力分析。
和为小车与摆杆相互作用力的水平和垂直方向的分量。
应用Newton方法来建立系统的动力学方程过程如下:
分析小车水平方向所受的合力,可以得到以下方程:
(2-1)
由摆杆水平方向的受力进行分析可以得到下面等式:
(2-2)
(2-3)
把这个等式代入上式中,就得到系统的第一个运动方程:
(2-4)
为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得到下面方程:
(2-5)
(2-6)
力矩平衡方程如下:
(2-7)
注意:
此方程中力矩的方向,由于,故等式前面有负号。
合并这两个方程,约去和,得到第二个运动方程:
(2-8)
2.1.2微分方程建模
设,当摆杆与垂直向上方向之间的夹角与1(单位是弧度)相比很小,即时,则可以进行近似处理:
,,。
为了与控制理论的表达习惯相统一,即一般表示控制量,用来代表被控对象的输入力,线性化后得到该系统数学模型的微分方程表达式:
(2-9)
2.1.3传递函数建模
对方程组(2-9)进行拉普拉斯变换,得到
(2-10)
注意:
推导传递函数时假设初始条件为0。
由于输出为角度,求解方程组(2-10)的第一个方程,可以得到
(2-11)
(2-12)
如果令,则有:
(2-13)
把上式代入方程组(2-10)的第二个方程,得到(2-14)
整理后得到以输入力为输入量,以摆杆摆角为输出量的传递函数(2-15)
其中
2.1.4状态空间数学模型
由现代控制理论原理可知,控制系统的状态空间方程可写成如下形式:
(2-16)
方程组(2-9)对解代数方程,得到如下解:
(2-17)
整理后得到系统状态空间方程:
(2-18)
由(2-9)的第一个方程为:
对于质量均匀分布的摆杆有:
于是可以得到:
化简得到:
(2-19)
设,则有:
(2-20)
2.2实际系统模型建立
实际系统参数如下,求系统的传递函数、状态空间方程,并进行脉冲响应和阶跃响应的Matlab仿真。
M
小车质量
0.5kg
m
摆杆质量
为0.2kg
b
小车摩擦系数
0.1N/m/sec
l
摆杆转动轴心到杆质心的长度(本实验为0.3m)
0.3m
I
摆杆惯量
0.006kg*m*m
F
加在小车上的力
x
小车位置
T
采样频率
0.005秒
θ
摆杆与垂直向下方向的夹角
1)摆杆角度和小车位移的传递函数
2)摆杆角度和小车加速度的传递函数
3)摆杆角度和小车外作用力的传递函数
4)以外界作用力作为输入的系统状态方程:
5)以小车加速度作为输入的系统状态方程
3系统定性、定量分析
3.1系统开环阶跃响应
状态空间法:
状态空间法可以进行单输入多输出系统设计,在此我们
将尝试同时对摆杆角度和小车位置进行控制。
在这里我们首先给小车一个阶跃输入信号,以外作用力为输入。
我们用Matlab求出系统的状态空间方程各矩阵。
并观察一下系统的开环阶跃响应。
可以看出,在单位阶跃响应作用下,小车位置和摆杆角度都是发散的
Matlab程序如下:
M=0.5;
m=0.2;
b=0.1;
I=0.006;
g=9.8;
l=0.3;
>>p=I*(M+m)+M*m*l^2;
A=[0100;
0-(I+m*l^2)*b/p(m^2*g*l^2)/p0;
0001;
0-(m*l*b)/pm*g*l*(M+m)/p0]
B=[0;(I+m*l^2)/p;0;m*l/p]
C=[1000;0010]
D=[0;0]
T=0:
0.005:
10;
U=0.2*ones(size(T));
[Y,X]=lsim(A,B,C,D,U,T);
plot(T,Y)
axis([02.50100])
Matlab给出系统状态空间方程的A,B,C和D矩阵,并绘出了在给定输入为一个0.2m的阶跃信号时系统的响应曲线。
3.2系统稳定性与可控性分析
3.2.1稳定性分析
我们先看一看系统的稳定性,将数据代入状态方程中,利用matlab程序可以求出系统的零极点。
源代码如下:
sysc=ss(A,B,C,D);
sysd=c2d(sysc,0.005);
[dadbdcdd]=ssdata(sysd);
[zpgain]=ss2zp(da,db,dc,dd,1)
z=
-0.9997-0.9997
1.02511.0000
0.97561.0000
p=
1.0000
1.0282
0.9993
0.9724
gain=
1.0e-004*
0.2272
0.5680
由得到的p(极点)可知,有的极点在单位圆外,所以可知原系统是不稳定
3.2.2能控性分析
我们可以利用matlab来得到系统的能控性,源代码如下:
ud=ctrb(da,db);
rank(ud)
ans=4
由得到的rank(ud)的值可知,原系统的能控性矩阵为4,所以我们可知原系统是能控的。
4设计状态观测器
4.1状态空间分析
状态方程为:
式中:
为状态向量(维),为控制向量(纯量),为维常数矩阵,为维常数矩阵。
选择控制信号:
求解上式,得到
方程解为:
可以看出,如果系统状态完全可控,选择适当,对于任意的初始状态,当趋于无穷时,都可以使趋于0。
4.2极点配置的设计步骤
(1)检验系统的可控性条件。
(2)从矩阵的特征多项式
来确定的值。
(3)确定使状态方程变为可控标准型的变换矩阵:
其中为可控性矩阵,
(4)利用所期望的特征值,写出期望的多项式
并确定的值。
(5)需要的状态反馈增益矩阵由以下方程确定:
4.3极点配置的Matlab计算
前面我们已经得到了直线一级倒立摆的状态空间模型,以小车加速度作为输入的系统状态方程为:
对于如上所述的系统,设计控制器,要求系统具有较短的调整时间(约5秒)和合适的阻尼(阻尼比)。
倒立摆极点配置原理图如图所示
极点配置步骤如下:
(1)检验系统可控性(以证)
(2)计算特征值
根据要求,并留有一定的裕量(设调整时间为3秒),我们选取期望的闭环极点,其中:
其中,是一对具有的主导闭环极点,位于主导闭环极点的左边,因此其影响较小,因此期望的特征方程为:
因此可以得到:
由系统的特征方程:
因此有
系统的反馈增益矩阵为:
(3)确定使状态方程变为可控标准型的变换矩阵:
式中:
于是可以得到:
(4)状态反馈增益矩阵为:
得到控制量为:
零输入响应
在零输入响应下,即不加扰动时小车和摆杆最终都回到平衡位置。
程序见下:
A=[0100;0000;0001;0024.50];
B=[0102.5]';
C=[1000;0010];
D=[00]';
J=[-15000;0-1500;00-1-0.8*i0;000-1+0.8*i];
pa=poly(A)
pj=poly(J)
M=[BA*BA^2*BA^3*B]
W=[pa(4)pa(3)pa
(2)1;pa(3)pa
(2)10;pa
(2)100;1000]
T=M*W
K=[pj(5)-pa(5)pj(4)-pa(4)pj(3)-pa(3)pj
(2)-pa
(2)]*inv(T)
Ac=[(A-B*K)]
Bc=B;
Cc=C;
Dc=D;
sys=ss(Ac,Bc,Cc,Dc)
t=0:
0.005:
10;
x0=[0.05;0;0.0175;0];
[y1,x]=initial(sys,x0,t);
●plot(t,y1(:
1),'red',t,y1(:
2),'green')
●当有扰动时即它的单位阶跃响应是:
上图是极点配置的单位阶跃响应,由图中也可以观察到在4秒左右小车和摆杆都达到平衡状态,满足题目要求的摆动时间小于5秒。
其次也可看到稳态时摆杆与垂直方向的夹角小于0.1度。
仿真程序如下:
A=[01
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 精品 一级 倒立