一级倒立摆控制系统设计

基于双闭环 PID控制的一阶倒立摆控制系统设计一、设计目的倒立摆是一个非线性、不稳定系统,经常作为研究比较不同控制方法的典型例子。设计一个倒立摆的控制系统，使倒立摆这样一个不稳定的被控对象通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统。二、设计要求倒立摆的设计要求是使摆杆尽快地达到一个平衡位置， 并且使之没有大的振荡和过大的角度和速度。当摆杆到达期望的位置后，系统能克服随机扰动而保持稳定的位置。实验参数自己选定，但要合理符合实际情况，控制方式为双PID控制，并利用MATLAB进行仿真，并用simulink对相应的模块进行仿真。三、设计原理倒立摆控制系统的工作原理是：由轴角编码器测得小车的位置和摆杆相对垂直方向的角度，作为系统的两个输出量被反馈至控制计算机。 计算机根据一定的控制算法，计算出空置量，并转化为相应的电压信号提供给驱动电路， 以驱动直流力矩电机的运动，从而通过牵引机构带动小车的移动来控制摆杆和保持平衡。四、设计步骤首先画出一阶倒立摆控制系统的原理方框图一阶倒立摆控制系统示意图如图所示：分析工作原理，可以得出一阶倒立摆系统原理方框图：精品文库一阶倒立摆控制系统动态结构图下面的工作是根据结构框图，分析和解决各个环节的传递函数！1.一阶倒立摆建模在忽略了空气流动阻力，以及各种摩擦之后，可将倒立摆系统抽象成小车和匀质杆组成的系统，如下图所示，其中：：小车质量m：为摆杆质量J：为摆杆惯量F：加在小车上的力x：小车位置θ：摆杆与垂直向上方向的夹角：摆杆转动轴心到杆质心的长度根据牛顿运动定律以及刚体运动规律，可知：（1）摆杆绕其重心的转动方程为JFlsinFlcos..........(1)yx（2）摆杆重心的运动方程为Fxd2lsin)..........(2)m2(xdt2mdFymg2(lcos).........(3)得dt欢迎下载 2精品文库（3）小车水平方向上的运动为d2xFFxM..........(4)d2t联列上述 4个方程，可以得出一阶倒立精确气模型：Jml2FmlJml2sin.2m2l2gsincosxJml2Mmm2l2cos2mlcos.Fm2l2sincos.2Mmmlgsinm2l2cos2MmJml2式中J为摆杆的转动惯量： J

ml23若只考虑θ在其工作点附近 θ0=0附近（ 10 10）的细微变化，则可以近似认为：2..(J2)F22g0xmlmlJ(Mm)Mml2sin..(Mm)mlgmlFcos1J(Mm)Mml2若取小车质量M=2kg,摆杆质量m=1kg,摆杆长度2l=1m,重力加速度取g=2,则可以得10m/s一阶倒立摆简化模型：..(s)s20.4x0.44F3.33拉氏变换F(s)12..1.1s20.4F12x(s)10(s)s2即G(s)=;G2(s)=1一阶倒立摆环节问题解决！电动机驱动器选用日本松下电工 MSMA021型小惯量交流伺服电动机，其有关参数如下：欢迎下载 3精品文库驱动电压：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。KvTmTls2Tms1G(s)KdKvKmKsKsFmax161.6Umax10即D3(s)=1.6电动机驱动器部分问题解决！双闭环PID控制器设计剩下的问题就是如何确定控制器 D1(S)D1'和D2(S)D2'(S)的结构和参数。（一）内环控制器的设计其中，Ks=1.6为伺服电动机与减速机构的等效模型欢迎下载 4精品文库控制器的选择内环系统未校正时的传递函数为(s)6.4F(s)s212对于内环反馈控制器D2(s)可有PD，PI，PID三种可能的结构形式，怎么选取呢？这里，不妨采用绘制各种控制器结构下“系统根轨迹”的办法加以分析比较，从之选出一种比较适合的控制器结构。各种控制器的开环传函的传递函数分别为：6.4KpP:s2126.4KDs6.4KpPD:12s26.4Kps6.4KIPI:12)s(s26.4Kps26.4Kps6.4KIPID:s(s212)在MATLAB下输入以下程序用“凑试”的方法画根轨迹图：num=[分子];den=[分母];xlabel('RealAxis');ylabel('ImagAxis');axis([横、纵坐标范围]);title('RootLocus');grid;rlocus(num,den)下图为各种控制器下的系统根轨迹。（a）PD （b）PD欢迎下载 5精品文库（c）PI d）PID从根轨迹不难发现，采用PD结构的反馈控制器，结构简单且可保证闭环系统的稳定。所以，选定反馈控制器的结构为 PD形式的控制器。2.控制器参数的选定首先暂定K=-20。这样可以求出内环的传递函数为：KKG(s)201.620.412W2:s2s221201.60.4(KP2SKd2)1KKG(s)D'(s)2s12s212.812.8Kd2S12.8KP212Wn212.8Kp21212.8K1.942W12.8K20.707解得：p2D20.39s1.94d212.8Kd20.39n系统内环传递函数为：W(s)12.82s25s12.8注释：工程上常用阻尼比=0.707作为二阶系统最优解！欢迎下载 6精品文库3.系统内环的simulink仿真及结果仿真结果为：欢迎下载 7精品文库（二）外环控制器的设计W212.81.1s21012.8(1.1s210)(s)G1(s)s2s2(s25s12.8)s25s12.8可见，系统开环传递函数可视为一个高阶（4阶）且带有不稳定零点的“非最小相位系统”，为了便于设计，需要首先对系统进行一些简化处理（否则，不便利用经典控制理论与方法对它进行设计）。１.系统外环模型的降阶（1）对内环等效闭环传递函数的近似处理W2(s)12.8...........(1)5ss212.8将高次项s2忽略，有12.81..........(2)W2(s)12.80.39s5s1近似条件可由频率特性导出，即W2(j)212.812.82(j)5(j)12.812.85j由（2）得：W212.8(j)5j12.82c

12.810 即： c 1.13（2）对象模型G1(s)的近似处理G1(s)1.1s210s2.........(3)G1(s)10.........(4)s2由（3）得：G1(j)1.1(j)210101.1222j欢迎下载 8精品文库由（4）得：G1(j)101022j1.1c2

1010

，所以，有 c 0.95W2(s)G1(s)1.102225.640.39s1ss(s2.564)近似条件为：cmin(1.13,0.95)0.95２.控制器设计设加入的调节器为D(s)K(s1)，同时，为使系统有较好的跟随性1p能，采用单位反馈 (D1(s) K 1)来构成外环反馈通道，如图所示：W(s)D1(s)W2(s)G1(s)25.641)Kp(ss2(s2.564)取c0.9h151.95取242.564W(s)20Kp(s0.5)s2(0.39s1)再由“典型Ⅱ型”系统Bode图特性（K1c）知：20Kp10.9Kp0.045.用simulink对小车的位置在阶跃信号输入下的响应进行仿真：系统框图为欢迎下载 9精品文库仿真结果：倒立摆位置在阶跃信号下的响应3.系统的simulink仿真连接图如下：欢迎下载 10精品文库仿真结果为：倒立摆在阶跃信号下摆杆和小车位置的响应从图中可以看出建立的一阶倒立摆控制系统在matlab中能够实现倒立摆的要求，能通过电动机牵引机构带动小车的移动来控制摆杆和保持平衡。为了进一步验证在不同摆杆下的，该一阶倒立摆控制系统是否还具有鲁棒特性，分别取摆杆不同的质量和摆长，进行 simulink仿真！欢迎下载 11精品文库由图可知，建立的一阶倒立摆模型在不同摆长下能实现要求。但摆长不能过长！同理，建立的一阶倒立摆模型在不同质量的摆杆下能也实现要求， 但同样不能过重！五、课程设计心得1、通过实验了解了一阶倒立摆是的非线性、不确定性、不稳定系统和约束限制