一级倒立摆的Simulink仿真

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

2、2sin,cos1 可以做如下线性化处理：3!2!当B很小时，由cos B、sin B的幕级数展开式可知，忽略高次项后,可得 cos B 帘 sin 0,0 B A20 ；因此模型线性化后如下：(J+mL2 ) 0' 'mlx''mgl0(a)ml 0' '(M+m) x''=u (b) 其中 J gml2取系统的状态变量为x1x, x2x, X3,输出y x包括小车位移和摆杆的角位移x1xx2x'xx1即X=Y=x3x3x4由线性化后运动方程组得X1' =x' =x2x2 '二x'3mg4

3、(M m) 3mX3+4(M m) 3m UX3 ' = B' =x4x4' = 0,3(M m)g4(M m)l3ml x3+4(M3m)l3ml U010x1'003mgX'-x2'4(Mm)3mX x3'=000x4'003(Mm)guu4(Mm)l3mlux1'0100x1x2'00267270x2X'x30001x3x4'x4003118180x1x11 0 00x2Yx30 0 10x3x4故空间状态方程如下:00x140x2+4(Mm)3m1x300x434(Mm)l3ml01.818

4、2+u045455、通过Matlab仿真判断系统的可控与可观性，并说明其物理意义(1)判断可控性代码：A-010 (0;00-2.6270;000 -1;0031.18180;B=0;1.8182;0;-4.5455;P=ctrb(A,B);n=ran k(P);运行了得n= 4所以 P 为满秩，系统能控2)判断可观性代码：A=010 0;00-2.6270;000;0031.18180;B=0;1.8182;0;-4.5455;C=1 0 0 0; 0 0 1 0;P=obsv(A,C); n=rank(P);运行了得 n= 4所以 P 为满秩，系统能观。三、能否通过状态反馈任意配置系统的极

5、点？若能，通过 Matlab 仿真确定反馈控制规律 K (如图 2)，使得闭环极点配置在1 1, 2 2, 3.4 1 j 上。并给出系统在施加一个单位脉冲输入时状态响应曲线；答： 因为系统完全能控，所以能通过状态反馈任意配置系统的极点。要将闭环极点配置在 1 1, 2 2, 3.4 1 j 上，所以期望特征方程为|刀一(A-BK)|=(入 + 1) * (廿2) *( ( Z+1) A2+1)=於4+5 於3+10 於2+10 入+4Matlab 求解 K 如下：A=010 0;00-2.6270;000;0031.18180;B=0;1.8182;0;-4.5455;J=-1 -2 -1+

6、i -1-i;K=place(A,B,J);运行得：K= -0.089378-0.22345 -9.0957 -1.1894;未加入极点配置。仿真图： 未进行极点配置仿真电路图( 1) X 的响应图：的响应图：配置后：加入极点配置仿真图( 2)X的响应图：的响应图：四、用MatLab中的lqr函数，可以得到最优控制器对应的K。要求用LQR控制算法控制倒立摆摆动至竖直状态，并可以控制倒立摆左 移和右移；欲对系统进行最优状态反馈设计，及小化性能指标为：1OO -T-TJ=牙 $ XTQX+ UTRUdt编写matalab程序如下：A=0 1 00;0 0 -2.627 0;0 0 0 1;0 0

7、31.18180;B=0;1.8182;0;-4.5455;C=1 0 0 0;0 0 1 0;D=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;3= C;D仁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由图分析可得调节时间很长，

8、所以增加Q的比重，将上程序中的x,y改为x=150,y=150.运行可得：G=-12.247 -9.3413 -41.934 -7.7732比较可得，控制效果明显改善。但反馈增益变大，意味着控制作用变强，消耗 能量变大。将 G 放入系统中，进行 simulink 仿真可得：仿真电路图： 仿真结果： X 的响应图： 的响应图：五、写出本次仿真实验的心得体会。本实验，从数学建模到仿真系统的搭建，再到加进控制环节进行实时控制， 最后得出结果的过程中， 参考了大量的资料， 通过对比整合， 设计出了适合自己 的一套实验方法： 倒立摆数学模型推导部分： 首先用线性化数学模型， 接着用动 态系统空间状态方程法导出状态方程系数矩阵，然后用 MATLAB 对系统进行可 控可观判断及进行几点配置，加入配置后在 Simulink 软件上进行系统仿真。最 后通过 matlab 求解线性二次型最优控制的 G 矩阵，然后加入形同进行 Simulink 仿真。 通过本实验，掌握了倒立摆仿真的整个过程，熟悉了 MATLAB 的仿真 软件