一级倒立摆控制系统设计.docx
《一级倒立摆控制系统设计.docx》由会员分享,可在线阅读,更多相关《一级倒立摆控制系统设计.docx(14页珍藏版)》请在冰豆网上搜索。
一级倒立摆控制系统设计
基于双闭环PID控制的一阶倒立摆控制系统设计
一、设计目的
倒立摆是一个非线性、不稳定系统,经常作为研究比较不同控制方法的典型例子。
设计一个倒立摆的控制系统,使倒立摆这样一个不稳定的被控对象通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统。
二、设计要求
倒立摆的设计要求是使摆杆尽快地达到一个平衡位置,并且使之没有
大的振荡和过大的角度和速度。
当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。
实验参数自己选定,但要合理符合实际情况,控制方式为双PID控制,并利用MATLAB进行仿真,并用simulink对相应的模块进行仿真。
三、设计原理
倒立摆控制系统的工作原理是:
由轴角编码器测得小车的位置和摆杆相对垂直方向的角度,作为系统的两个输出量被反馈至控制计算机。
计算机根据一定的控制算法,计算出空置量,并转化为相应的电压信号提供给驱动电路,以驱动
直流力矩电机的运动,从而通过牵引机构带动小车的移动来控制摆杆和保持平衡。
四、设计步骤
首先画出一阶倒立摆控制系统的原理方框图一阶倒立摆控制系统示意图如图所示:
工业控制计算机电动机驱动器一阶倒立摆
一阶倒立摆控制系统动态结构图
F面的工作是根据结构框图,分析和解决各个环节的传递函数!
1■一阶倒立摆建模
在忽略了空气流动阻力,以及各种摩擦之后,可将倒立摆系统抽象成小车和
l:
摆杆转动轴心到杆质心的长度
根据牛顿运动定律以及刚体运动规律,可知:
(1)摆杆绕其重心的转动方程为
J鎳Fylsin二-Fxlcos:
(1)
(2)摆杆重心的运动方程为
(3)
小车水平方向上的运动为
联列上述4个方程,可以得出
一阶倒立精确气模型:
式中J为摆杆的转动惯量:
J』
3
若只考虑B在其工作点附近00=0附近(-10—”:
10)的细微变化,则可
以近似认为:
g=10m/s2,则可以得
一阶倒立摆简化模型:
阶倒立摆环节问题解决!
2.电动机驱动器
选用日本松下电工MSMA02型小惯量交流伺服电动机,其有关参数如下:
MSDA021A1AS制电压:
UDA=0±10V。
若忽略电动机的空载转矩和系统摩擦,就可以认为驱动器和机械传动装置
均为纯比例环节,并假设这两个环节的增益分别为Kd和Km
Kv
TmTs2Tms1
G(s)=KdKvK^Ks
―芒粧.6
即D3(s)=1.6
电动机驱动器部分问题解决!
3.双闭环PID控制器设计
剩下的问题就是如何确定控制器
U(S)D,和D2(S)D2‘(S)的结构和参数。
(一)内环控制器的设计
反惯校正控制的系统内环框图
其中,Ks=1.6为伺服电动机与减速机构的等效模型
1.控制器的选择
内环系统未校正时的传递函数为出
F(s)s-12
对于内环反馈控制器D2(s)可有PD,PI,PID三种可能的结构形式,怎么选取呢?
这里,不妨采用绘制各种控制器结构下“系统根轨迹”的办法加以分析比较,从之选出一种比较适合的控制器结构。
各种控制器的开环传函的传递函数分别为:
在MATLAB下输入以下程序用凑试”的方法画根轨迹图:
num=[分子];
den=[分母];
xlabel('RealAxis');ylabel('lmagAxis');axis([横、纵坐标范围]);title('RootLocus');grid;
rlocus(num,den)
下图为各种控制器下的系统根轨迹。
从根轨迹不难发现,采用PD结构的反馈控制器,结构简单且可保证闭环系
统的稳定。
所以,选定反馈控制器的结构为PD形式的控制器2.控制器参数的选定
首先暂定K=-20。
这样可以求出内环的传递函数为:
12.8
2
s12.Kd2S12.KP2-12
注释:
工程上常用阻尼比=0.707作为二阶系统最优解!
3.系统内环的simulink仿真及结果
HieEdtWewEmulationForiftatTodsHe|p
D|dHS诒电鸟►
Wornal
\rCorrTTandVfirtfow
In1
>o
0bt1
Ready
:
00:
i
T=0.C<
仿真结果为:
StepResccnse
1.2-
Dpn・-durl%
VPropertyEcftar
Chfiracten
Chanacberistcs
Slwsettingtimewthn
Showrisethefrom
(二)外环控制器的设计
-1.1s1012.8(-1.1s210)s2_s2(s25s12.8)
可见,系统开环传递函数可视为一个高阶(4阶)且带有不稳定零点的“非最小相位系统”,为了便于设计,需要首先对系统进行一些简化处理(否则,不便利用经典控制理论与方法对它进行设计)。
1.系统外环模型的降阶
(1)对内环等效闭环传递函数的近似处理
将高次项s2忽略,有
1281
W2(s)—8-
(2)
5s+12.80.39S+1
近似条件可由频率特性导出,即
(2)对象模型G1(s)的近似处理
-1.1s2+10
G(s)2(3)
s
G(s)
10
s
-1.1(j)210
由(4)得:
1010
1.1{
10
违,所以’有^0.95
再由“典型U型”系统Bode图特性(K八「c)知:
20Kp=10.9Kp=0.045
3用simulink对小车的位置在阶跃信号输入下的响应进行仿真:
系统框图为
仿真结果:
倒立摆位置在阶跃信号下的响应
3•系统的simulink仿真
连接图如下:
Gai13
Ci'ivstiFiGs[胸
仿真结果为:
倒立摆在阶跃信号下摆杆和小车位置的响应
从图中可以看出建立的一阶倒立摆控制系统在matlab中能够实现倒立摆的
要求,能通过电动机牵引机构带动小车的移动来控制摆杆和保持平衡。
为了进一步验证在不同摆杆下的,该一阶倒立摆控制系统是否还具有鲁棒特
性,分别取摆杆不同的质量和摆长,进行simulink仿真!
由图可知,建立的一阶倒立摆模型在不同摆长下能实现要求。
但摆长不能过
长!
同理,建立的一阶倒立摆模型在不同质量的摆杆下能也实现要求,但同样不
能过重!
五、课程设计心得
1通过实验了解了一阶倒立摆是的非线性、不确定性、不稳定系统和约束限制,同时倒立摆也是经常作为研究比较不同控制方法的典型例子。
2、对一阶倒立摆控制系统的研究使我了解到倒立摆还有二阶倒立摆、三阶倒立摆,甚至四阶倒立摆,同时还涉及到起摆的问题!
增加了了倒立摆研究的兴趣!
3、建立的一阶倒立摆控制系统忽略了许多因素,应用一些简化处理,即建立的只是一阶倒立摆控制系统的简化模型。
当摆杆的质量和摆长超过一定范围,系统失效,所以该系统有待改进!
j)