一级倒立摆控制系统设计
- 格式：doc
- 大小：2.08 MB
- 文档页数：15
一级倒立摆控制系统设计 自动控制原理课程设计
2 基于双闭环PID控制的一阶倒立摆控制系统设计
一、设计目的
倒立摆是一个非线性、不稳定系统,经常作为研究比较不同控制方法的典型例子。设计一个倒立摆的控制系统，使倒立摆这样一个不稳定的被控对象通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统。
二、设计要求
倒立摆的设计要求是使摆杆尽快地达到一个平衡位置，并且使之没有大的振荡和过大的角度和速度。当摆杆到达期望的位置后，系统能克服随机扰动而保持稳定的位置。实验参数自己选定，但要合理符合实际情况，控制方式为双PID控制，并利用 MATLAB进行仿真，并用simulink对相应的模块进行仿真。
三、设计原理
倒立摆控制系统的工作原理是：由轴角编码器测得小车的位置和摆杆相对垂直方向的角度，作为系统的两个输出量被反馈至控制计算机。计算机根据一定的控制算法，计算出空置量，并转化为相应的电压信号提供给驱动电路，以驱动直流力矩电机的运动，从而通过牵引机构带动小车的移动来控制摆杆和保持平衡。
四、设计步骤
首先画出一阶倒立摆控制系统的原理方框图
一阶倒立摆控制系统示意图如图所示：
分析工作原理，可以得出一阶倒立摆系统原理方框图： 自动控制原理课程设计
3 自动控制原理课程设计
4 （3）小车水平方向上的运动为
22..........(4)xdxFFMdt
联列上述4个方程，可以得出
一阶倒立精确气模型：
2222222222222222sin.sincoscoscos.sincos.lgsincosJmlFmlJmlmlgxJmlMmmlmlFmlMmmmlMmJml
式中J为摆杆的转动惯量：32mlJ
若只考虑θ在其工作点附近θ0=0附近（1010）的细微变化，则可以近似认为：
1cossin02
2..2222..)(lg)()()(MmlmMJmlFmmMMmlmMJglmFmlJx
若取小车质量M=2kg,摆杆质量m=1kg,摆杆长度2 l =1m,重力加速度取g=2/10sm,则可以得
一阶倒立摆简化模型：
....0.443.330.412xFF 拉氏变换
即 G1(s)= ; G2(s)=
一阶倒立摆环节问题解决！
2.电动机驱动器 222()0.4()12()1.110()sFssxssss自动控制原理课程设计
5 选用日本松下电工MSMA021型小惯量交流伺服电动机，其有关参数如下：
驱动电压：U=0~100V 额定功率：PN=200W
额定转速：n=3000r/min 转动惯量：J=3×10-6kg.m2
额定转矩：TN=0.64Nm 最大转矩：TM=1.91Nm
电磁时间常数：Tl=0.001s 电机时间常数：TM=0.003s
经传动机构变速后输出的拖动力为：F=0~16N；与其配套的驱动器为：MSDA021A1A，控制电压：UDA=0~±10V。
若忽略电动机的空载转矩和系统摩擦，就可以认为驱动器和机械传动装置均为纯比例环节，并假设这两个环节的增益分别为Kd和Km。
12sTsTTKvmlm
6.11016)(maxmaxUFKKKKKsGssmvd
即D3(s)=1.6
电动机驱动器部分问题解决！
3.双闭环PID控制器设计
剩下的问题就是如何确定控制器)()()('22'11SDSDDSD和的结构和参数。
（一）内环控制器的设计
自动控制原理课程设计
6
其中，Ks=1.6为伺服电动机与减速机构的等效模型
1.控制器的选择
内环系统未校正时的传递函数为2()6.4()12sFss
对于内环反馈控制器D2(s)可有PD，PI，PID三种可能的结构形式，怎么选取呢？这里，不妨采用绘制各种控制器结构下“系统根轨迹”的办法加以分析比较，从之选出一种比较适合的控制器结构。
各种控制器的开环传函的传递函数分别为：
26.4:12pKPs
22226.46.4:126.46.4:(12)6.46.46.4:(12)DppIppIKsKPDsKsKPIssKsKsKPIDss
在MATLAB下输入以下程序用“凑试”的方法画根轨迹图：
num=[分子];
den=[分母];
xlabel('Real Axis');
ylabel('Imag Axis');
axis([横、纵坐标范围]);
title('Root Locus');
grid;
rlocus(num,den)
下图为各种控制器下的系统根轨迹。 自动控制原理课程设计
7
（a） PD （b） PD
（c）PI d） PID
从根轨迹不难发现，采用PD结构的反馈控制器，结构简单且可保证闭环系统的稳定。所以，选定反馈控制器的结构为PD形式的控制器。
2.控制器参数的选定
首先暂定K=-20。这样可以求出内环的传递函数为： 自动控制原理课程设计
8 222222222220.4201.6()12:0.41()'()1201.6()1212.812.812.812ssPddPKKGssWKKGsDsKSKssKSK
2222222212.81212.81.940.391.940.39212.820.70712.812.8()512.8nppdndWKKDsKWKWsss解得：系统内环传递函数为：
注释：工程上常用阻尼比=0.707作为二阶系统最优解！
3.系统内环的simulink仿真及结果
自动控制原理课程设计
9 仿真结果为：
（二） 外环控制器的设计
2221222212.81.11012.8(1.110)()()512.8(512.8)ssWsGsssssss
可见，系统开环传递函数可视为一个高阶（4阶）且带有不稳定零点的“非最小相位系统”，为了便于设计，需要首先对系统进行一些简化处理（否则，不便利用经典控制理论与方法对它进行设计）。
１.系统外环模型的降阶
（1）对内环等效闭环传递函数的近似处理
2212.8()...........(1)512.8Wsss
将高次项2s忽略，有
212.81()..........(2)512.80.391Wsss
近似条件可由频率特性导出，即 自动控制原理课程设计
10 22212.812.8()()5()12.812.85Wjjjj
由（2）得：212.8()512.8Wjj
212.810c 1.13c即：
（2）对象模型G1(s)的近似处理
2121.110().........(3)sGss
1210().........(4)Gss
由（3）得：221221.1()10101.1()jGjj
由（4）得：2211010)(jjG
2101.110c ，所以，有0.95c
212211025.64()().0.391(2.564)WsGsssss
近似条件为：min(1.13,0.95)0.95c
２.控制器设计
设加入的调节器为 )1()(1sKsDp ，同时，为使系统有较好的跟随性能，采用单位反馈)1)((1KsD来构成外环反馈通道，如图所示：
121225.64()()()()(1)(2.564)pWsDsWsGsKsss 自动控制原理课程设计
11 取0.9c
12.564h 51.954 2取
220()(0.5)(0.391)pWsKsss
再由“典型Ⅱ型”系统Bode图特性（ cK1 ）知：
2010.9pK 0.045pK
３.用simulink对小车的位置在阶跃信号输入下的响应进行仿真：
系统框图为
仿真结果： 自动控制原理课程设计
12
倒立摆位置在阶跃信号下的响应
3.系统的simulink仿真
连接图如下：
仿真结果为： 自动控制原理课程设计
13
倒立摆在阶跃信号下摆杆和小车位置的响应
从图中可以看出建立的一阶倒立摆控制系统在matlab中能够实现倒立摆的要求，能通过电动机牵引机构带动小车的移动来控制摆杆和保持平衡。
为了进一步验证在不同摆杆下的，该一阶倒立摆控制系统是否还具有鲁棒特性，分别取摆杆不同的质量和摆长，进行simulink仿真！
自动控制原理课程设计
14
由图可知，建立的一阶倒立摆模型在不同摆长下能实现要求。但摆长不能过长！同理，建立的一阶倒立摆模型在不同质量的摆杆下能也实现要求，但同样不能过重！
五、课程设计心得
1、通过实验了解了一阶倒立摆是的非线性、不确定性、不稳定系统和约束限制,同时倒立摆也是经常作为研究比较不同控制方法的典型例子。
2、对一阶倒立摆控制系统的研究使我了解到倒立摆还有二阶倒立摆、三阶
