2022年倒立摆MATLAB建模 .pdf

《2022年倒立摆MATLAB建模 .pdf》由会员分享，可在线阅读，更多相关《2022年倒立摆MATLAB建模 .pdf（11页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、线控大作业如图所示的倒立摆系统。 图中，倒立摆安装在一个小车上。 这里仅考虑倒立摆在图面内运动的二维问题。图倒立摆系统假定倒立摆系统的参数如下。摆杆的质量： m=0.1g 摆杆的长度： 2l=1m 小车的质量： M=1kg 重力加速度： g=10/s2 摆杆惯量： I=0.003kgm2 摆杆的质量在摆杆的中心。设计一个控制系统，使得当给定任意初始条件(由干扰引起 ) 时，最大超调量 %10% ，调节时间 ts 4s ，使摆返回至垂直位置，并使小车返回至参考位置(x=0) 。要求： 1、建立倒立摆系统的状态方程2、定量分析 , 定性分析系统的性能指标能控性、能观性、稳定性3、极点配置设计分析报

2、告名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 1 页，共 11 页 - - - - - - - - - 1 系统建模在忽略了空气阻力和各种摩擦之后， 可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统。如下如所示。图 一级倒立摆模型其中：摆杆与垂直向上方向的夹角摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）图是系统中小车和摆杆的受力分析图。其中，N 和 P 为小车与摆杆相互作用力的水平和垂直方向的分量。注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定，因而矢

3、量方向定义如图所示，图示方向为矢量正方向。分析小车水平方向所受的合力，可以得到以下方程：NxbFxM由摆杆水平方向的受力进行分析可以得到下面等式：)sin(22lxdtdmN即：名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 2 页，共 11 页 - - - - - - - - - sincos2mlmlxmN把这个等式代入式 (3-1)中，就得到系统的第一个运动方程：FmlmlxbxmMsincos)(2为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面

4、方程：)cos(22ldtdmmgPcossin2mlmlmgP力矩平衡方程如下：INlPlcossin注意：此方程中力矩的方向，由于sinsin,coscos,，故等式前面有负号。合并这两个方程，约去P 和N，得到第二个运动方程：cossin)(2xmlmglmlI设（是摆杆与垂直向上方向之间的夹角） ，假设与 1（单位是弧度）相比很小，即1，则可以进行近似处理：0)( ,sin, 1cos2dtd。用 u来代表被控对象的输入力F ，线性化后两个运动方程如下：2( +)()ImlmglmlxMm xbxmlu对式(3-9)进行拉普拉斯变换，得到)()()()()()()()()(22222s

5、UssmlssbXssXmMssmlXsmglssmlI注意：推导传递函数时假设初始条件为0。由于输出为角度，求解方程组的第一个方程，可以得到：)()()(22ssgmlmlIsX或m g lsmlImlssXs222)()()(如果令xv，则有：名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 3 页，共 11 页 - - - - - - - - - mglsmlImlsVs22)()()(把上式代入方程组的第二个方程，得到：)()()()()()(2222sUssmlsssgmlm

6、lIbsgmlmlImM整理后得到传递函数：sqbmglsqmglmMsqmlIbssqmlsUs23242)()()()(其中22)()(mlmlImMq设系统状态空间方程为：DuCXyBuAXX方程组 对 ,x解代数方程，得到解如下：uMm lmMImlMm lmMImMmglxMm lmMImlbuMm lmMImlIMm lmMIglmxMm lmMIbmlIxxx2222222222)()()()()()()()()(整理后得到系统状态空间方程：uMm lmMImlMm lmMImlIxxMm lmMImMmglMm lmMImlbMm lmMIglmMm lmMIbmlIxx222

7、2222222)(0)(00)()()(010000)()()(00010uxxxy0001000001代入倒立摆系统的参数。摆杆的质量： m=0.1g 摆杆的长度： 2l=1m 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 4 页，共 11 页 - - - - - - - - - 小车的质量： M=1kg 重力加速度： g=10/s2 摆杆惯量： I=0.003kgm2 010000010100010001101xxxxuuxxxy0001000001另外，也可以利用MATLAB

8、 中 tf2ss 命令对 (3-13)式进行转化，求得上述状态方程。2 系统分析2.1 判断系统能控性和能观性在 MATLAB 中，可以利用 ctrb()和 obsv()函数直接求出能控性和能观性矩阵A=0 1 0 0;0 0 1 0;0 0 0 1;0 0 11 0; B=0;1;0;1; C=1 0 0 0;0 0 1 0; D=0;0; Uc=ctrb(A,B);rc=rank(Uc); n=size(A); if rc=n disp(system is controlled.) elseif rcn disp(system is uncontrolled.) end Vo=obsv(A

9、,C); ro=rank(Vo); if ro=n disp(system is observable.) elseif ro=n disp(system is no observable.) 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 5 页，共 11 页 - - - - - - - - - End 运行情况如下：2.2 系统稳定性A=0 1 0 0;0 0 1 0;0 0 0 1;0 0 11 0; B=0;1;0;1; C=1 0 0 0;0 0 1 0; D=0;0; P

10、=poly(A),v=roots(P) 运行结果如下：名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 6 页，共 11 页 - - - - - - - - - 特征值为 0（二重） ，3.3166,-3.3166，显然，其中一个极点在右半平面，该系统不稳定。3 系统设计极点配置与控制器设计极点配置的方法就是通过一个适当的状态反馈增益矩阵的状态反馈方法,将闭环系统的极点配置到任意期望的位置。( )( )( )X tAx tBu t=+，其中 x 是状态变量（ n 维） ，u 是控制信号

11、，这里选取控制信号为uKx= -，( )()( )x tABKx t=-，该方程的解为()( )(0)ABK tx tex-=，系统的稳态响应和瞬态响应特性由矩阵A - B K 的特征决定。()1234KKKKKx= -，闭环系统的方程为()xAxBfABK x=+=-， 选 取 所 希 望 的 极 点 值 为 ，1234pppp设计状态反馈阵时，要使系统的极点设计成具有两个主导极点，两个非主导名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 7 页，共 11 页 - - - - -

12、- - - - 极点，这样就可以用二阶系统的分析方法进行参数的确定。最大超调量小于等于10%，调节时间为 4S，运用超调量的计算公式，21%100%ezpzd-=，其中z为阻尼系数，有该公式可求得，阻尼系数z=0.59，小于 1，是欠阻尼。33()sntszws=-为极点实部，可以求得nw=1.27 则 极 点 公 式 为21 , 21nnpjzwz w= -?， 得 到 两 个 共 轭 极 点 为1 , 20 . 7 51 . 0 2 5pj= -. 配置非主导极点3415,15pp= -= -，在 MATLAB 的控制系统工具箱中提供了单变量系统极点配置acker(),其格式为K=acke

13、r(A,B,p) 程序如下：A=0 1 0 0;0 0 -2 0;0 0 0 1;0 0 22 0; B=0;1;0;-1; C=1 0 0 0;0 1 0 0；0 0 1 0；0 0 0 1; D=0; rc=rank(ctrb(A,B); p=-0.75+1.025j,-0.75-1.025j,-15,-15; K=acker(A,B,p) 运行结果如下：名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 8 页，共 11 页 - - - - - - - - - 4 程序及其执行结果

14、该二阶系统的阶跃响应为下图所示脉冲响应：名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 9 页，共 11 页 - - - - - - - - - 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 10 页，共 11 页 - - - - - - - - - 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 11 页，共 11 页 - - - - - - - - -