哈工大控制系统设计大作业——直线一级倒立摆控制器设计

1、Harbin Institute of Technology课程设计说明书（论文）课程名称： 控制系统设计课程设计 设计题目：直线一级倒立摆控制器设计院 系：航天学院控制科学与工程系班 级： 设 计 者： 学 号： 指导教师： 罗晶 设计时间： 2012.8.272012.9.9 哈尔滨工业大学教务处哈尔滨工业大学课程设计任务书 姓 名： 张盛博 院 （系）：航天学院控制科学与工程系 专 业： 探测制导与控制技术 班 号：0904201 任务起至日期： 2012 年 8 月 27 日至 2012 年 9 月 9 日 课程设计题目： 直线一级倒立摆控制器设计 已知技术参数和设计要求：本课程设计的

2、被控对象采用固高公司的直线一级倒立摆系统GIP-100-L。系统内部各相关参数为：小车质量 0.5 Kg ；摆杆质量0.2 Kg ；小车摩擦系数0.1 N/m/sec ； 摆杆转动轴心到杆质心的长度0.3 m ；摆杆惯量0.006 kg*m*m ；采样时间0.005秒。设计要求：1推导出系统的传递函数和状态空间方程。用Matlab进行阶跃输入仿真，验证系统的稳定性。2设计PID控制器，使得当在小车上施加0.1N的脉冲信号时，闭环系统的响应指标为：（1）稳定时间小于5秒；（2）稳态时摆杆与垂直方向的夹角变化小于0.1 弧度。3设计状态空间极点配置控制器，使得当在小车上施加0.2m的阶跃信号时，闭

3、环系统的响应指标为：（1）摆杆角度和小车位移的稳定时间小于3秒（2）的上升时间小于1秒（3）的超调量小于20度（0.35弧度）（4）稳态误差小于2%。 工作量：1. 建立直线一级倒立摆的线性化数学模型；2. 倒立摆系统的PID控制器设计、MATLAB仿真及实物调试；3. 倒立摆系统的极点配置控制器设计、MATLAB仿真及实物调试。 工作计划安排：第3周 （1）建立直线一级倒立摆的线性化数学模型；（2）倒立摆系统的PID控制器设计、MATLAB仿真；（3）倒立摆系统的极点配置控制器设计、MATLAB仿真。第4周 （1）实物调试；（2）撰写课程设计论文。 同组设计者及分工：各项工作独立完成。 指导

4、教师签字_ 年 月 日 教研室主任意见： 教研室主任签字_ 年 月 日*注：此任务书由课程设计指导教师填写。一、 直线一级倒立摆数学模型的推导及建立 系统建模可以分为两种：机理建模和实验建模。实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号，激励研究对象并通过传感器检测其可观测的输出，应用数学手段建立起系统的输入输出关系。这里面包括输入信号的设计选取，输出信号的精确检测，数学算法的研究等等内容。机理建模就是在了解研究对象的运动规律基础上，通过物理、化学的知识和数学手段建立起系统内部的输入状态关系。 对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难。但是经过小心

5、的假设忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。下面我们采用其中的牛顿欧拉方法建立直线型一级倒立摆系统的数学模型。 1.1、微分方程的推导 在忽略了空气阻力，各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统. 下图是系统中小车和摆杆的受力分析图。其中，N和P为小车与摆杆水平和垂直方向的分量。图1（a）小车隔离受力图 （b）摆杆隔离受力图本系统相关参数定义如下： M : 小车质量 m：摆杆质量 b：小车摩擦系数 l：摆杆转动轴心到杆质心的长度 I：摆杆惯量 F：加在小车上的力 x：小车位置 ：摆杆与垂直

6、向上方向的夹角 ：摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下） 注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示，图示方向为矢量正方向。 分析小车水平方向所受的合力，可以得到以下方程： 由摆杆水平方向的受力进行分析可以得到下面等式：即 把这个等式代入上式中，就得到系统的第一个运动方程： 为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面方程： 即 力矩平衡方程如下： 注意：此方程中力矩的方向，由于，故等式前面有负号。 合并这两个方程，约去P和N ，得到第二个运动方程：1、微分方程模型 设（是摆杆与垂直向上方向之间的夹

7、角），假设与1（单位是弧度）相比很小,即，则可以进行近似处理：。用u来代表被控对象的输入力F ，线性化后两个运动方程如下： 2、传递函数 对以上微分方程组进行拉普拉斯变换，得到 注意：推导传递函数时假设初始条件为0。 由于输出为角度为，求解方程组上述方程组的第一个方程，可以得到或者 （1-12）如果令，则有 （1-13）把上式代入10式，则有： （1-14）整理： （1-15）其中 3、状态空间数学模型，可得状态方程二、 直线一级倒立摆PID控制器设计2.1、PID控制器各个校正环节对系统的影响简单来说,PID控制器各个校正环节的作用如下:（1） 比例环节：成比例的反应控制系统的偏差信号e(t

8、)，偏差一旦产生，控制器立即产生控制作用，以减少偏差。（2）积分环节：主要用于消除稳态误差，提高系统的型别。积分作用的强弱取决于积分时间常数T1，T1越大，积分作用越弱，反之则越强。（3） 微分环节：反映偏差信号的变化趋势（变化速率），并能在偏差信号值变得太大之前，在系统中引入一个有效的早期修正信号，从而加快系统的动作速度，减小调节时间。22、PID控制器的设计及MATLAB仿真 首先，对于倒立摆系统输出量为摆杆的角度，它的平衡位置为垂直向上。系构框图如下： 图3 直线一级倒立摆PID控制系统框图中KD(s)是控制器传递函数，G(s)是被控对象传递函数。考虑到输入r(s)=0，结构图可以很容易

9、的变换成图4 直线一级倒立摆PID控制简化系统框图 该系统的输出为 其中，num被控对象传递函数的分子项 den被控对象传递函数的分母项 numPIDPID 控制器传递函数的分子项 denPIDPID 控制器传递函数的分母项 被控对象的传递函数是 其中：PID控制器的传递函数为 需仔细调节PID 控制器的参数，以得到满意的控制效果。 前面的讨论只考虑了摆杆角度，那么，在我们施加控制的过程中，小车位置如何变化呢？ 考虑小车位置，得到改进的系统框图如下：图5 直线一级倒立摆PID控制改进系统框图 其中，是摆杆传递函数，是小车传递函数。 由于输入信号r(s)=0 ，所以可以把结构图转换成：图5 直线

10、一级倒立摆PID控制简化后改进系统框图其中，反馈环代表我们前面设计的控制器。 小车位置输出为：其中，num1 ,den1,num2, den2 分别代表被控对象1和被控对象2传递函数的分子和分母。 numPID和denPID 代表PID 控制器传递函数的分子和分母。 下面我们来求G2(s)，根据前面的推导:可以推出小车位置的传递函数为:其中：可以看出，den1=den2=den，小车的传递函数可以简化成： 2.3、PID控制器参数的调节按题目要求，施加0.1N的脉冲信号，观察指标。脉冲信号仿真源程序为：M = 0.5;m = 0.2;b = 0.1;I = 0.006;g = 9.8;l =

11、0.3;num1 = m*l;den1 = (I+m*l2) 0 -m*g*l;Kp = 1;Ki = 0; Kd = 0;numPID = Kd Kp Ki;denPID = 1 0;num = conv(num1,denPID);den = polyadd(conv(denPID,den1),conv(numPID,num1 ); r,p,k = residue(num,den);s = p t=0:0.005:5;impulse(0.1*num,den,t)grid当系统加入PID控制器后的方框图为：直线一级倒立摆PID控制MATLAB仿真模型由所查阅资料，调节Kp，会影响ess和振荡次

12、数以及ts；Kp太大不稳定，Kp可以选择负数。调节Ki，会影响稳定性，ess。调节Kd,会影响，ts;由于Kd的特殊性，必须选择合适的Kd才能使与ts均位于合适的范围。具体的调试过程：先调节Kp使系统稳定；再调节Kd使系统仅有一次振荡；最后调节Ki使ess为0。令Kp=130、Ki=130、Kd=10，得到以下仿真结果：直线一级倒立摆PID控制仿真结果图（Kp=130、Ki=130、Kd=10）4、PID系统的优缺点优点：PID控制优点明显，应用广泛。PID能消除稳态误差；同时可以减少超调量，克服振荡，使系统的稳定性提高；并且能加快系统的动态响应速度，减小调整时间，从而改善系统的动态性能。缺点

13、：PID控制的过度期比较长，上升过程中波动明显；当然，较好的PID控制效果是以已知被控对象的精确数学模型为前提的，当被控对象的数学模型未知时，PID控制的调试将会有很大的难度。三、 状态空间极点配置控制器设计，解得=0.59，wn=3.39=0.804，符合要求。根据（1）摆杆角度和小车位移的稳定时间小于3秒（3）的超调量小于20度（0.35弧度）（4）稳态误差小于2%求得闭环主导极点为：，选取另两个极点为-12，-12。则：1、 仿真程序：A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 24.5000 0;B=0;1;0;2.5000;C=1 0 0 0;0 0 1 0;D=0;

14、0;J=-12 0 0 0;0 -12 0 0;0 0 -2-2.74*i 0;0 0 0 -2+2.74*i;JA=poly(A);a1=JA(2);a2=JA(3);a3=JA(4);a4=JA(5);M=B A*B A2*B A3*B;W=a3 a2 a1 1;a2 a1 1 0;a1 1 0 0;1 0 0 0;T=M*W;JJ=poly(J)aa1=JJ(2);aa2=JJ(3);aa3=JJ(4);aa4=JJ(5);K=aa4-a4 aa3-a3 aa2-a2 aa1-a1*(inv(T);Ac = (A-B*K);Bc = B;Cc = C;Dc = D;T = 0:0.005

15、:5;U = 0.2*ones(size(T);Cn = 1 0 0 0;Nbar = rscale(A,B,Cn,0,K);Bcn = Nbar*B;Y,X = lsim(Ac,Bcn,Cc,Dc,U,T);figure(1)plot(T,X(:,1),r);grid;legend(Cart Position);figure(2);plot(T,X(:,3),g);grid;legend(Pendulum Angle);K =1.0e+003 *(-6.0245 -2.4514 8.5677 1.0782)倒摆小车位置、倒摆小车速度、倒摆倾角、倒摆倾角速度的响应曲线倒摆小车位置响应曲线倒摆倾角的响应曲线状态反馈系统的主要优点是极点的任意配置，无论开环极点和零点在什么位置，都可以任意配置期望的闭环极点。这为我们提供了控制系统的手段，假如系统的所有状态都可以被测量和反馈的话，状态反馈可以提供简单而适用的设计四、 实物调试试验4.1直线一级倒立摆PID控制实验采用固高科技的一级倒立摆模型进行PID控制器实物调试，系统框图如图所示：直线一级倒立摆MATLAB-PID实时控制界面由实验结果所示可看出系统较稳定，调节过程比较平稳，干扰作用下，系统能很快回到平衡位置，说明这组PID参数具有较好的控制效果,满足设计要求。直线一级倒立摆PID控制