一阶倒立摆控制系统剖析

一阶直线倒立摆系统姓名：班级：学号：-1-目录摘要 3第一部分 单阶倒立摆系统建模 4（一） 对象模型 4（二）电动机、驱动器及机械传动装置的模型 6第二部分 单阶倒立摆系统分析第三部分 单阶倒立摆系统控制

711（一）内环控制器的设计 11（二） 外环控制器的设计 14第四部分 单阶倒立摆系统仿真结果 16系统的simulink 仿真 16-2-摘要：该问题源自对于娱乐型”独轮自行车机器人”的控制，实验中对该系统进行系统仿真，通过对该实物模型的理论分析与实物仿真实验研究，有助于实现对独轮自行车机器人的有效控制。控制理论中把此问题归结为“一阶直线倒立摆控制问题”。另外，诸如机器人行走过程中的平衡控制、火箭发射中的垂直度控制、卫星飞行中的姿态控制、海上钻井平台的稳定控制、飞机安全着陆控制等均涉及到倒立摆的控制问题。实验中通过检测小车位置与摆杆的摆动角，来适当控制驱动电动机拖动力的大小，控制器由一台工业控制计算机（IPC）完成。实验将借助于“ Simulink 封装技术——子系统”，在模型验证的基础上，采用双闭环 PID控制方案，实现倒立摆位置伺服控制的数字仿真实验。实验过程涉及对系统的建模、对系统的分析以及对系统的控制等步骤，最终得出实验结果。仿真实验结果不仅证明了 PID方案对系统平衡控制的有效性，同时也展示了它们的控制品质和特性。第一部分 单阶倒立摆系统建模-3-（一） 对象模型由于此问题为”单一刚性铰链、两自由度动力学问题”，因此， 依据经典力学的牛顿定律即可满足要求。如图1.1所示，设小车的质量为m0，倒立摆均匀杆的质量为 m，摆长为2l，摆的偏角为，小车的位移为x，作用在小车上的水平方向上的力为F，O1为摆杆的质心。图1.1 一阶倒立摆的物理模型根据刚体绕定轴转动的动力学微分方程， 转动惯量与角加速度乘积等于作用于刚体主动力对该轴力矩的代数和，则1）摆杆绕其重心的转动方程为JFylsinFxlcos（1-1）2）摆杆重心的水平运动可描述为md2Fx2(xslin)（1-2）dt3）摆杆重心在垂直方向上的运动可描述为d2（1-3）Fymgm2(clos)dt4）小车水平方向运动可描述为FFxm0d2x（1-4）dt2-4-由式（1-2）和式（1-4）得(m0 m)x m(lcos sin2 )F（1-5）由式（1-1）、式（1-2）和式（1-3）得(J m2l) mclos x mlgsin （1-6）整理式（1-5）和式（1-6），得2l(mJ2m)lsin222(Jml)Fmlsginx2m)222(Jml)(mmlcos022lsincos2m(mm)mlcosFm022202mlcos(mm)(Jml)

cos（1-7）lgsin因为摆杆是匀质细杆，所以可求其对于质心的转动惯量。 因此设细杆摆长为2l，单位长度的质量为 l，取杆上一个微段 dx，其质量为m ldx，则此杆对于质心的转动惯量有Jl2ll3/3(ldx)x2l杆的质量为m2ll所以此杆对于质心的转动惯量有 J

ml23由式（2-20）可见，一阶直线倒立摆系统的动力学模型为非线性微分方程组。为了便于应用经典控制理论对该控制系统进行设计，必须将其简化为线性定常的系统模型。若只考虑 在其工作点 0 0附近（ 10 10）的细微变化，则可近似认20为 sincos 1在这一简化思想下，系统精确模型式（ 1-7）可简化为(Jml2)Fm2l2gxm)mml2J(m00(m0 m)mlg mlF2J(m0 m) mm0l-5-若给定一阶直线倒立摆系统的参数为：小车的质量m02kg；倒摆振子的质量m1kg；；2倒摆长度2l0.6m重力加速度取g10m/s，则可得到进一步的简化模型为x0.44F3.33(1-8)0.4F12上式为系统的”微分方程模型”，对其进行拉普拉斯变换可得系统的传递函G1(s)0.4(s)s212数模型为F(s)（1-9）X(s)1.1s2G210(s)s2(s)（二）电动机、驱动器及机械传动装置的模型假设：选用日本松下电工 MSMA021型小惯量交流伺服电动机，其有关参数如下：驱动电压：U=0~100V额定功率：N=200WP额定转速：n=3000r/min转动惯量：J3106kgm2额定转矩：TN0.64Nm最大转矩：TM1.91Nm电磁时间常数：Tl=0.001s电机时间常数：Tm=0.003s经传动机构变速后输出的拖动力为：F=0~16N；与其配套的驱动器为：MSDA021A1A，控制电压：UDA=（0~±）。10V若忽略电动机的空载转矩和系统摩擦， 就可以认为驱动器和机械传动装置均为纯比例环节，并假设这两个环节的增益分别为 Kd和Km。对于交流伺服电动机，其传递函数可近似为KvTmTls2 Tms 1由于是小惯性的电动机，其时间常数 Tl、Tm相对都很小，这样可以进一步将电动机模型近似等效为一个比例环节 Kv。综上所述，电动机。驱动器。机械传动装置三个环节就可以合成为一个比例环节-6-G(s) KdKvKm KsFmax16Ks1.6Umax10第二部分 单阶倒立摆系统分析尽管上述数学模型系经机理建模得出，但其准确性（或正确性）还需运用一定的理论方法加以验证，以保证以其为基础的仿真实验的有效性。采用仿真实验的方法在MATLAB的Simulink图形仿真环境下进行模型验证试验，其原理如图1.2所示。其中，上半部分为精确模型仿真图，下半部分为简化模型仿真图。图1.2 模型验证原理图利用Simulink 压缩子系统功能可将验证原理图更加简捷的表示为图 1.3所示的形式。其中，由得到的精确模型和简化模型的状态方程，可得到 Fcn、Fcn1、Fcn2和Fcn3的函数形式为Fcn:(0.12*u[1]+0.036*sin(u[3])*power(u[2],2)-0.9*sin(u[3])*cos(u[3]))/(0.24-0.09*power(cos(u[3]),2))Fcn(1):(0.3*cos(u[3])*u[1]+0.09*sin(u[3])*cos(u[3])*power(u[2],2)-6*sin(u[3]))/(0.09*power(cos(u[3]),2)-0.24)-7-Fcn(2):0.8*u[1]-0.6*u[3]Fcn(3):40*u[3]-2.0*u[1]图1.3 利用子系统封装后的框图假定使倒立摆在（ 0,x 0）初始状态下突加微小冲击力作用，则依据经验知，小车将向前移动，摆杆降倒下。下面利用仿真实验来验证正确数学模型的这一必要性质。编制绘图子程序：InvertedpendulumModeltestinopenloopSingnalsrecuperation将导入到xy.mat中的仿真实验数据读出loadxy.matt=signals(1,:);%读取时间信号f=signals(2,:);%读取作用力F信号x=signals(3,:);%读取精确模型中的小车位置信号q=signals(4,:);%读取精确模型中的倒立摆摆角信号xx=signals(5,:);%读取简化模型中的小车位置信号qq=signals(6,:);%读取简化模型中的倒立摆摆角信号Drawingcontrolandx(t)responsesignals画出在控制力的作用下的系统响应曲线定义曲线的横纵坐标、标题、坐标范围和曲线的颜色等特征-8-figure(1)%定义第一个图形hf=line(t,f(:));%连接时间-作用力曲线gridon;xlabel(‘Time(s)’)%定义横坐标ylabel(‘Force（N）’)%定义纵坐标axis([0100.12])%定义坐标范围axet=axes(‘position’，get(gca,‘position’),‘XAxisLocation’,‘bottom’,‘YAxisLocation’,’right’,’Color’,’None’,‘XColor’,’k’,’YColor’,’k’）;% 定义曲线属性ht=line(t,x, ’color’,’r’,’parent’,axet);%连接时间-小车位置曲线ht=line(t,xx,’color’,’r’,’parent’,axet);%连接时间-小车速度曲线ylabel(‘Evolutionofthexposition(m)’)%定义坐标名称axis([0100.1])%定义坐标范围title(‘Responsexandx’’inthemetertoaf(t)pulseof0.1N’)%定义曲线标题名称gtext(‘\leftarrowf(t)’),gtext(‘x(t)\rightarrow’),gtext(‘\leftarrowx’’(t)’)drawingcontrolandtheta(t)responsesingalsfigure(2)hf=line(t,f(:));gridonxlabel(‘Time’)ylabel( ‘ForceinN’)axis([0100.12])-9-axet=axes(‘Position’,get(gca, ’Position’),‘XAxisLocation’,’bottom’,‘YAxisLocation’,’right’,’Color’,’None’,‘XColor’,’k’,’YColor’,’k’);ht=line(t,q, ‘color’,’r’,’parent’,axet);ht=line(t,qq, ’color’,’r’,’parent’,axet);ylabel( ‘Angleevolution(red) ’)axis([01-0.30])title （‘response\theta(t)and\theta ’’(t)inradtoaf(t)pulseof0.1N’）gtext( ‘\leftarrowf(t) ’),gtext( ‘\theta （t）\rightarrow ’),gtext(‘\leftarrow\theta ’’(t)’)执行该程序的结果如图 1.4所示。从中可见，在 0.1N的冲击力作用下，摆杆倒下（ 由零逐步增大），小车位置逐渐增加，这一结果符合前述实验设计，故可以在一定程度上确认该“一阶倒立摆系统”的数学模型是有效的。同时，由图中也可看出近似模型在 0.8s以前与精确模型非常接近，因此，也可以认为近似模型在一定条件下可以表述原系统模型的性质。-10-图1.4 模型验证仿真结果第三部分 单阶倒立摆系统控制由于一阶倒立摆系统位置伺服控制的核心是“在保证摆杆不倒的条件下，使小车位置可控”。因此，依据负反馈闭环控制原理，将系统小车位置作为“外环”，而将摆杆摆角作为“内环”，则摆角作为外环内的一个扰动，能够得到闭环系统的有效抑制（实现其直立不倒的自动控制）。剩下的问题就是如何确定控制器（校正装置） D1(s)D1'(s)和D2(s)D2'(s)的结构和参数。（一）内环控制器的设计图1.5反馈校正控制的系统内环框图-11-其中，Ks=1.6为伺服电动机与减速机构的等效模型控制器的选择内环系统未校正时的传递函数为

(s) 6.4F(s) s2 12对于内环反馈控制器错误！未找到引用源。 D2(s)可有PD，PI，PID三种可能的结构形式，这里，不妨采用绘制各种控制器结构下“系统根轨迹”的办法加以分析比较，从之选出一种比较适合的控制器结构。 各种控制器的开环传函的传递函数分别为：6.4KpP:12s2PD:6.4KDs6.4Kps2126.4Kps6.4KIPI:s(s212)PID:6.4Kps26.4Kps6.4KIs(s212)在Matlab下输入以下程序用“凑试”的方法画根轨迹图：num=[分子];den=[分母];xlabel('RealAxis');ylabel('ImagAxis');axis([横、纵坐标范围]);title('RootLocus');grid;rlocus(num,den)下图为各种控制器下的系统根轨迹：错误！未找到引用源。-12-（a）PD （b）PD（c）PI d）PID从根轨迹不难发现，采用PD结构的反馈控制器，结构简单且可保证闭环系统的稳定。所以，选定反馈控制器的结构为 PD形式的控制器。2.控制器参数的选定首先暂定K 20。这样可以求出内环的传递函数为：KKsG2(s)201.60.412W2:s2KKsG2(s)D'2(s)0.411201.6s2(KP2SKd2)1212.8s212.8Kd2S12.8KP212Wn212.8Kp21212.8Kp21.94解得：D20.39s1.942Wn12.8Kd220.70712.8Kd20.39系统内环传递函数为：W2(s)12.85s12.8s23.系统内环的simulink仿真及结果-13-仿真结果为：（二） 外环控制器的设计W2(s)G112.81.1s21012.8(1.1s210)(s)s2s2(s25s12.8)s25s12.8可见，系统开环传递函数可视为一个高阶（4阶）且带有不稳定零点的“非最小相位系统”，为了便于设计，需要首先对系统进行一些简化处理。１.系统外环模型的降阶（1）对内环等效闭环传递函数的近似处理W2(s)12.8...........(1)s25s12.8-14-将高次项s2忽略，有W212.81..........(2)(s)12.80.39s5s1近似条件可由频率特性导出，即W2(j)212.812.8)5(j)12.812.825j(j12.8由（