一级倒立摆的建模与控制分析

1、报告题目直线一级倒立摆建模、分析及控制器的设计组员1专业、班级14自动化1班姓名朱永远学号1405031009组员1专业、班级14自动化1班姓名王宪孺学号1405031011组员1专业、班级14自动化1班姓名孙金红学号1405031013报告评分标准评分项目权重评价内容评价结果项目得分内容70设计方案较合理、正确，内容较完整70-50分设计方案基本合理、正确，内容基本完整50-30分设计方案基本不合理、正确，内容不完整0-30分语言组织15语言较流顺，标点符号较正确10-15分语言基本通顺，标点符号基本正确5-10分语言不通顺，有错别字，标点符号混乱5分以下格式15报告格式较正确，排版较规范美

2、观10-15分报告格式基本正确，排版不规范5-10分报告格式不正确，排版混乱5分以下总分直线一级倒立摆建模、分析及控制器的设计一状态空间模型的建立1.1 直线一级倒立摆的数学模型图1.1直线一级倒立摆系统本文中倒立摆系统描述中涉及的符号、物理意义及相关数值如表1.1所示。表1.1直线一级倒立摆系统参数符号意义实际数值M小车质量1.096kg摆杆质虽0.109kgf小车摩擦力01N/m/sec1摆杆转动轴心到杆质心的反度025111I摆朴惯虽0.00223kg*m*m图1.2是系统中小车的受力分析图。其中，N和P为小车与摆杆相互作用力的水平和垂直方向的分量。10PCtFg0FlimgN到的垂直方

3、向的干扰力，合力是垂直方向夹角为a的干扰力F。g图1.2系统中小车的受力分析图图1.3是系统中摆杆的受力分析图。F是摆杆受到的水平方向的干扰力，F是摆杆受sh图1.3摆杆受力分析图分析小车水平方向所受的合力，可以得到以下方程G-1)设摆杆受到与垂直方向夹角为a的干扰力Fg,可分解为水平方向、垂直方向的干扰力，所产生的力矩可以等效为在摆杆顶端的水平干扰力FS、垂直干扰力Fh产生的力矩。(1-2)对摆杆水平方向的受力进行分析可以得到下面等式：N-F=md-(x+1sin0)(1-3)Sdt2即：N=mx+m10cos0-m102sin0+Fsina(1-4)f对图1.3摆杆垂直方向上的合力进行分析

4、，可以得到下面方程：-P+mg+F=m-(l-1cos0)(1-5)h恥一P+mg+Fcosa=m10sin0+ml02cos0(1-6)g力矩平衡方程如下：Flsinacos0+Flcosasin0+Plsin0+Nlcos0+10=0Mx=F-(1fx-7-)N代入P和N，得到方程：()2Flsinacos9+2Flcosasin0+Y+mlcos20怡+mglsin0-ml202sin20+mXcos0=0(1-8)F=FsinaF=FcosaSghg设0=兀+©,(©是摆杆杆与垂直向上方向之间的夹角，单位是弧度)，代入上式。假设©<<1,则可进

5、行近似处理:cose=1,sine=eldt丿=0,cos2e=1,sin2e=e由于：I=ml2方程化为：32F(-sina-©cosa)+ml©-mg©=mxg3(1-9)令：F=F(-sina-©cosa)，则(1-9)可化为fgmg©=mx(1-10)即是化简后的直线一级倒立摆系统微分方程。带入实际数据后，微分方程为O'=29.46+3x-2Ffm（1-11）当忽略了卩”寸，系统的微分方程如式（1-12）所示6=29.46+3X（1-12）忽略干扰力后，直线一级倒立摆系统是单输入二输出的四阶系统，考虑干扰力后，直线一级倒立摆系统

6、是二输入二输出的四阶系统。其内部的4个状态量分别是小车的位移x、小车的速度x、摆杆的角度、摆杆的角速度6。系统输出的观测量为小车的位移X、摆杆的角度0。其控制量为小车的加速度6将微分方程（1-12）化为关于加速度输入量和角度输出量的传递函数6（s）=3RSOs2一29.4(1-13)x_000000000x_01.2 直线一级倒立摆系统的状态方程实验所使用的直线一级倒立摆系系统是加速度x作为系统的控制输入，所以根据式（1-12）建立系统的状态方程为：x=xx=x0=00=3g0+2x414l整理后得到系统状态方程：x-0_1x0Li+03g_4?_10000003g4l0010x0001L0将

7、实际参数代入得到一级倒立摆系统的状态空间方程为：01000LL000011000oB=C=D=L00010001000029.403A=二运动分析、能控性及能观性分析2.1运动分析线性定常系统非齐次状态方程为：x(t)=Ax(/)+Bu(/)则其解为：系统的输出方程为：y(0=Cx(r)+Du(z)则y(t)=Cx(fj+c£eA(f-T)Bu(t)dr+Du(“运动分析可以借助计算机的MATLAB进行。用MATLAB仿真求线性非齐次状态方程的解实例如例1所示。例1已知系统状态方程为用以下MATLAB程序求系统方程的解。其中，collect()函数的作用是合并同类项，而ilaplac

8、e()函数的作用是求取拉普拉斯逆变换，函数det()的作用是求方阵的行列式，语句phi=subs(phi0,'t',(t-tao)表示将符号变量phiO中的自变量t用(t-tao)代换就构成了符号变量phi,而语句x2=int(F,tao,0,t)表示符号变量F对tao在0到t的积分区间上求积分，运算结果返回到x2。symsstxOxtphiphi.0;%声明75号A=LO1Z-3:I-i0：01:B二0：1J：E=s*I-A；C=detCEJ;D=collect(invCE)J;pKiO=i1aplace(D):x0=1;0：stl二：plti=subs(pRiO?*t7*；

9、F=phi*B*l;x2iittCF.0t):K=ccllecttc1+x2)程序执行结果为这表示2.2系统能控性分析系统的可控性可根据秩判据进行可控性判断。线性定常连续系统完全可控的充分必要条件是：rank(BABAn-1B)二n，其中n为系统矩阵A的阶次，M=(BABAn-iB)为系统的可控性矩阵。matlab程序及运行结果如下：>>A=0100;0000;0001;0029.40;>>B=0;1;0;3;>>T=ctrb(A,B);>>rank(T)ans=4由于rank(Ic)=4，可见该系统是完全可控的。2.3系统能观测性分析系统的可控

10、性可根据秩判据进行可控性判断。线性定常连续系统完全可控的充分必要条件是：_C_CArankN=rank=n或rank(CtAtCt(At)2Ct(At)n-1Ct)=nCAn-1其中n为系数矩阵A的阶次。matlab程序及运行结果如下：>>A=0100;0000;0001;0029.40;>>C=1000;0010;>>T0=obsv(A,C);rank(T0)ans=4由于rank(TO)=4，故该系统是可观测的。三状态反馈与状态观测器设计3.1状态反馈原理设n维线性定常系统：X=Ax+Bu,y=Cx其中x,u,y分别是n维、p维、q维向量；A、B、C分别

11、是n*n维，n*p维，n*q维实数矩阵。状态反馈系统的控制量u取为状态x的线性函数：u=v-Kx其中，V为p参考输入向量，K为p*n维实反馈增益矩阵。加入状态反馈后系统的结构图如图3.1所示：图3.1系统的全状态反馈结构图则系统状态反馈的动态方程为：X=（A一BK）x+Bv,y=Cx3.2 状态反馈观测器和simulink仿真状态反馈的的实现是利用状态反馈使系统的闭环极点位于所希望的极点位置。而状态反馈任意配置闭环极点的充分必要条件是被控系统可控。直线一级倒立摆系统是可控的。设系统期望极点为R九九九二1一2-3-4+3i-4-3i，则系统期望特1234征多项式为：a*C）=C一九）C一九）C一

12、九）C一九）1234列写状态反馈系统的特征多项式：det（SI-A+BK）令两个特征多项式各项系数对应相等，则可解出K阵。由matlab求出状态反馈矩阵K，编程如下：A=0100;0000;0001;0029.40;>>B=0;1;0;3;>>K=acker(A,B,-2-3-4+3i-4-3i)K=-5.1020-5.884435.16736.2948系统加入0.1m/s2的阶跃输入，在构成的状态反馈调节器控制下，MATLAB中进行系统的阶跃响应仿真，编程如下：A=0100000000010029.40;B1=0103;C=1000010000100001;D1=00

13、00'dt=0.005;ieof=801;fori=1:ieof;U(:,i)=0.1;T(i)=i*dt;end;%离散化op=-2%期望极点-3-4+3i-4-3i;K=place(A,B1,op)Ak0=(A-B1*K);Bk0=B1;Ck0=C;Dk0=D1;lqrop=eig(Ak0);x=0000'dt=0.005;%离散时dA,dB=c2d(AkO,BkO,dt);%经离散化得到离散状态方程Ak1=(A-B1*K);Bk1=B1;Ck1=C;Dk1=D1;sys=ss(Ak1,Bk1,Ck1,Dk1);Y,X=lsim(sys,U,T);plot(T,-Y),gr

14、id;legend('Cart','VCart','single','Vs');图3.2极点配置为-2-3-4+3i-4-3i时的全状态反馈仿真图横轴时间单位秒，从图中可以看出，系统稳定。四总结通过对一级倒立摆的分析可知，在开环情况下，倒立摆的平衡系统是不稳定的的；通过秩判据可知，其系统是可控可观测的；以上都是利用MATLAB对其进行分析和设计，对其系统进行了稳定性、可控性、可观测性分析，以及极点配置和最优控制设计，从中我们可以看出，MATLAB作为一种交互式计算分析软件，其强大的运算分析功能，集科学计算、程序设计和可视化于一体的高度集成化软件环境，为控制系统的分析设计，特别是高阶系统综合设计，提供了一种方便可靠的途径。参考文献1李国勇，控制系统数字仿真与CADM,北京：电子工业出版社，2003,92王丹力，MATLAB控制系统设计仿真应用M，北京：中国电力出版社，2007,9薛定宇，控制系统仿真与计算机辅助设计M，北京：机械工业出版社，2005,14金以慧，过程控制M，北京：清华大学出版社，2003，6刘金琨.先进PID控制及其MATLAB仿真M.北京：电子工业出版社，2003,薛定宇.控制系统计