倒立摆MATLAB建模

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

2、各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆 组成的系统。如下如所示。图 一级倒立摆模型其中：摆杆与垂直向上方向的夹角0摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）图是系统中小车和摆杆的受力分析图。 其中，N和P为小车与摆杆相互作用力的水平 和垂直方向的分量。注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定，因而矢量方 向定义如图所示，图示方向为矢量正方向。分析小车水平方向所受的合力，可以得到以下方程： 由摆杆水平方向的受力进行分析可以得到下面等式： 即：把这个等式代入式 （3-1） 中，就得到系统的第一个运动方程：为了推出系统的第二个运动方程，我们对摆杆垂直

3、方向上的合力进行分析，可以得 到下面方程：力矩平衡方程如下：注意：此方程中力矩的方向，由于,coscos ,sinsin ,故等式前面有负号。合并这两个方程，约去P和N，得到第二个运动方程：设(是摆杆与垂直向上方向之间的夹角)，假设 与1 (单位是弧度)相比很小，即1,则可以进行近似处理：cos 1,sin,()2 0。用u来代表被dt控对象的输入力F ,线性化后两个运动方程如下：对式(3-9)进行拉普拉斯变换，得到 注意：推导传递函数时假设初始条件为0。由于输出为角度，求解方程组的第一个方程，可以得到：(s)mis2X (s) (I ml2)s2 mgl如果令v x，则有：把上式代入方程组的

4、第二个方程，得到：整理后得到传递函数：其中q (M m)(l ml2) (ml)2设系统状态空间方程为：方程组 对x,解代数方程，得到解如下：整理后得到系统状态空间方程：代入倒立摆系统的参数。摆杆的质量：m=摆杆的长度：2l =1m小车的质量：M=1kg重力加速度：g=10/s2摆杆惯量：I=另外，也可以利用MATLAB中tf2ss 命令对(3-13)式进行转化，求得上述状态方程。2系统分析判断系统能控性和能观性在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

5、 0;0 0 1 0;D=0;0;Uc=ctrb(A,B);rc=rank(Uc); n=size(A);if rc=ndisp(system is controlled.)elseif rcndisp(system is uncontrolled.)endVo=obsv(A,C);ro=rank(Vo);if ro=ndisp(system is observable.)elseif ro=ndisp(system is no observable.)End运行情况如下：系统稳定性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

6、 0 1 0;D=0;0;P=poly(A),v=roots(P)运行结果如下：特征值为 0(二重)，, ，显然，其中一个极点在右半平面，该系统不稳定3 系统设计 极点配置与控制器设计极点配置的方法就是通过一个适当的状态反馈增益矩阵的状态反馈方法 , 将闭环系 统的极点配置到任意期望的位置。)&(t)= Ax(t)+ Bu(t)，其中x是状态变量(n维)，u是控制信号，这里选取控制信 号为 u= - Kx ，X(t)= (A- BK)?x(t)，该方程的解为 x(t)= e(A-BK)t?x(O),系统的稳态响应和瞬态响应特性由矩阵A - B K 的特征决定。K = - (Ki K2 K3 K

7、4)?x，闭环系统的方程为&= Ax+ Bf = (A- BK)x，选取所希望的极点值为，pi P2P3 P4设计状态反馈阵时，要使系统的极点设计成具有两个主导极点，两个非主导极点，这样就可以用二阶系统的分析方法进行参数的确定。最大超调量小于等于10%调节时间为4S,运用超调量的计算公式，一 zpd%= e ?100%，其中z为阻尼系数，有该公式可求得，阻尼系数 z二，小于 1,是欠阻尼。33ts =(- S为极点实部)，可以求得 wn =zwns则极点公式为P1,2= - zWn? j1 z2Wn，得到两个共轭极点为P1,2 = - 0.75? j1.025.配置非主导极点P3 = - 15, P4 = - 15，在MATLA的控制系统工具箱中提供了单变量系统极点配置acker(),其格式为K=acker(A,B,p)程序如下：A=0 1 0 0;0 0 -2 0;0 0 0 1;0 0 22