一级倒立摆的Simulink仿真

《一级倒立摆的Simulink仿真》由会员分享，可在线阅读，更多相关《一级倒立摆的Simulink仿真（11页珍藏版）》请在金锄头文库上搜索。

1、单级倒立摆稳定控制直线一级倒立摆系统在忽略了空气阻力及各种摩擦之后，可抽象成小车和匀质摆杆组 成的系统，如图1所示。图1直线一级倒立摆系统图2控制系统结构假设小车质量M =0.5kg,匀质摆杆质量m=0.2kg,摆杆长度2l =0.6m, x(t)为小车的水平位移，0为摆杆的角位移，g 9.8m/s2。控制的目标是通过外力 u使得摆直立向上(即(J ml2)(ml cos )(t) 0)。该系统的非线性模型为:(mlcos )x mglsin2(M m)x (ml sin )解:非线性模型线性化及建立状态空间模型因为在工作点附近(0,0)对系统进行线性化，所以32sin,cos 1可以做如下线

2、性化处理：3!2!当8很小时，由cos 8、sin 8的幕级数展开式可知，忽略高次项后,可得 cos 0 4, sin 0 O a2前；因此模型线性化后如下:(a)ml O +(M+m) x =u (b)其中J1ml2 3取系统的状态变量为X1X, X2X, X3,X4，输出y xT包括小车位移和摆杆的角位移.x1即 x= x2x3x4XY=x1x3由线性化后运动方程组得X1, =x，=x2x2 =x3mg4(M m) 3mx3+u4(M m) 3mX3 =8 =x43( M m)g4(Mm)13mlx3+4(M3 m)lu 3ml(J+m1A2 ) O +mlx =mgl 801000x10

3、03mg0x14x24(M m) 3mx2+4(Mm) 3mx3-0001x30x4003(M m)g0x43故空间状态方程如下:X=4(M m)13ml4(Mm)1 3mlX=x1x2267270x3x4x1x2x3x41.8182311818045455x1x11000x2Y= =x30010x3x4二、 通过 Matlab 仿真判断系统的可控与可观性， 并说明其物理意义。( 1 )判断可控性代码：A=0100;0 0 -2.6270;0 001;0 0 31.18180;B=0;1.8182;0;-4.5455;P=ctrb(A,B);n=rank(P);运行了得 n= 4所以 P 为满

4、秩，系统能控( 2 )判断可观性代码：A=0100;0 0 -2.6270;0 001;0 0 31.18180;B=0;1.8182;0;-4.5455;C=10 0 0;0 010;P=obsv(A,C);n=rank(P);运行了得 n= 4所以 P 为满秩，系统能观。三、 能否通过状态反馈任意配置系统的极点？若能，通过Matlab 仿真确定反馈控制规律 K (如图 2) ， 使得闭环极点配置在11, 22, 3.41 j 上。并给出系统在施加一个单位脉冲输入时 状态响应曲线；答： 因为系统完全能控，所以能通过状态反馈任意配置系统的极点。1 j 上，所以期望特征方程为要将闭环极点配置在1

5、, 22, 3.4一 一(A-BK)尸(入+ 1) * ( H2) *(叶1)人2+1)=F4+5 43+10 12+10 入+4Matlab求解K如下：A=0100;00 -2.6270;0 001;0 0 31.18180;B=0;1.8182;0;-4.5455;J=-1 -2 -1+i-1-i;K=place(A,B,J);运行得：K= -0.089378-0.22345 -9.0957 -1.1894;未加入极点配置。仿真图：未进行极点配置仿真电路图（1)X的响应图:Tme oi fset: 00的响应图:配置后:X的响应图:加入极点配置仿真图（2）0的响应图: n x|昌昌 A必用

6、葩寇翻B皿I br J Rli !；! 11 n 1 , 1* ra riiini ra rnrBr Btraaiw ；：；：-C.41111024BS1(1Time oi fet: 0四、用MatLab中的Iqr函数，可以得到最优控制器对应的K。要求用LQR控制算法控制倒立摆摆动至竖直状态，并可以控制倒立摆左移和右移；欲对系统进行最优状态反馈设计，及小化性能指标为：J=十 jXTQX+ UTRUdt编写matalab程序如下：A=0 1 00;0 0 -2.627 0;0 0 01;0 0 31.1818 0;B=0;1.8182;0;-4.5455;C=1 0 0 0;0 0 1 0;D=

7、0;0x=1;y=1;Q=x 0 0 0;0 0 0 0;0 0 y 0;0 0 0 0;R=1;G=lqr(A,B,Q,R);A1=(A-B*G);B1=B;C1=C;D1=D;t=0:0.01:5;U=zeros(size(t);x0=0.1 0 0.1 0;Y,X=lsim(A1,B1,C1,D1,U,t,x0);plot(t,Y);legend( 小车 , 倒立摆 );运行可得：G=-1 -1.5495 -18.68 -3.4559由图分析可得调节时间很长，所以增加 Q的比重，将 上程序中的x,y改为x=150,y=150.运行可得：-.1 凶File Edi t Vi e* Inse

8、rl Tiols 口电gJttbp Vini*w Help不 mis等q戏已.毙I 口回I 口 inG=-12.247 -9.3413 -41.934 -7.7732比较可得，控制效果明显改善。但反馈增益变大，意味着控制作用变强，消耗 能量变大。将G放入系统中，进行simulink仿真可得：仿真电路图：0的响应图:仿真结果:X的响应图:五、写出本次仿真实验的心得体会。本实验，从数学建模到仿真系统的搭建，再到加进控制环节进行实时控制， 最后得出结果的过程中，参考了大量的资料，通过对比整合，设计出了适合自己 的一套实验方法：倒立摆数学模型推导部分：首先用线性化数学模型，接着用动 态系统空间状态方程法导出状态方程系数矩阵，然后用MATLAB对系统进行可控可观判断及进行几点配置，加入配置后在Simulink软件上进行系统仿真。最后通过matlab求解线性二次型最优控制的 G矩阵，然后加入形同进行 Simulink 仿真。通过本实验，掌握了倒立摆仿真的整个过程，熟悉了 MATLAB的仿真 软件Simulink的使用，也对系统控制有了较好的理解。通过仿真，再次认识到 了自动控制在改善系统性能方面的重要性， 并激发了良好的关于系统控制方面的 学习兴趣。除此之外，通过本次大作业，让我学会了很多word的操作，在此基础上，相信在以后的学习将会有较大帮助。