1、 线控大作业如图所示的倒立摆系统。图中,倒立摆安装在一个小车上。这里仅考虑倒立摆在图面内运动的二维问题。图 倒立摆系统假定倒立摆系统的参数如下。摆杆的质量:m=0.1g摆杆的长度:2l=1m小车的质量:M=1kg重力加速度:g=10/s2摆杆惯量:I=0.003kgm2摆杆的质量在摆杆的中心。设计一个控制系统,使得当给定任意初始条件(由干扰引起)时,最大超调量 %10%,调节时间 ts 4s ,使摆返回至垂直位置,并使小车返回至参考位置(x=0)。要求:1、建立倒立摆系统的状态方程2、定量分析,定性分析系统的性能指标能控性、能观性、稳定性3、极点配置设计分析报告1 系统建模在忽略了空气阻力和各
2、种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统。如下如所示。图 一级倒立摆模型其中: 摆杆与垂直向上方向的夹角 摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)图是系统中小车和摆杆的受力分析图。其中,N 和 P 为小车与摆杆相互作用力的水平和垂直方向的分量。 注意:在实际倒立摆系统中检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示,图示方向为矢量正方向。 分析小车水平方向所受的合力,可以得到以下方程: NxbFM由摆杆水平方向的受力进行分析可以得到下面等式: )sin(2ldtm即:sincos2mllxN把这个等式代入式(3-1)中,就得到系统的第一个运
3、动方程: FllbmMi)( 2为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得到下面方程: )cos(2ldtgPin2mll力矩平衡方程如下: INlPlcossi注意:此方程中力矩的方向,由于 ,sini,cos, 故等式前面有负号。 合并这两个方程,约去 和 ,得到第二个运动方程: cssin)(2xmlglmlI 设 ( 是摆杆与垂直向上方向之间的夹角) ,假设 与 1(单位是 弧度)相比很小,即 ,则可以进行近似处理:1。用 来代表被控对象的输入力 ,线性化后两0)(,sin,1co2dtuF个运动方程如下: 2(+)ImlglxMxbu对式(3-9)进行拉
4、普拉斯变换,得到 )()()()( 22 sUlsXsllI注意:推导传递函数时假设初始条件为 0。 由于输出为角度 ,求解方程组的第一个方程,可以得到: )()()2sgmlIsX或 lslIs2)()如果令 ,则有:xvmglslIsV2)()把上式代入方程组的第二个方程,得到: )()()()()()( 222 sUlslIbsgmlIM整理后得到传递函数: sqbmglqlMsqlIbslU23242)()()(其中 22)()(mllIq设系统状态空间方程为: DuCXyBA方程组 对 解代数方程,得到解如下:,x uMmlImlMIglxmlIb lIlIlIx 222 2222
5、)()()( )()()( 整理后得到系统状态空间方程: uMmlIlIxMmlIglmlMIbllIx 2222222 )(00)()(0 1)(1 uxxy010代入倒立摆系统的参数。摆杆的质量:m=0.1g摆杆的长度:2l=1m小车的质量:M=1kg重力加速度:g=10/s2摆杆惯量:I=0.003kgm2 0101xxu uxxy010另外,也可以利用 MATLAB 中 tf2ss 命令对(3-13)式进行转化,求得上述状态方程。 2 系统分析2.1 判断系统能控性和能观性在 MATLAB 中,可以利用 ctrb()和 obsv()函数直接求出能控性和能观性矩阵A=0 1 0 0;0
6、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=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运行情况如下:2.2 系统稳定性A=0 1 0 0;0
7、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=poly(A),v=roots(P)运行结果如下:特征值为 0(二重) ,3.3166,-3.3166,显然,其中一个极点在右半平面,该系统不稳定。3 系统设计 极点配置与控制器设计极点配置的方法就是通过一个适当的状态反馈增益矩阵的状态反馈方法 ,将闭环系统的极点配置到任意期望的位置。,其中 x 是状态变量(n 维) ,u 是控制信号,这里选()()()XtAxtBut=+取控制信号为 ,K-,该方程的解为 ,()(xtt ()(0ABKttex-=系统的稳态响应和瞬态响应特性
8、由矩阵 A - B K 的特征决定。,闭环系统的方程为)1234x=-,选取所希望的极点值为,(xABf+-1234pp设计状态反馈阵时,要使系统的极点设计成具有两个主导极点,两个非主导极点,这样就可以用二阶系统的分析方法进行参数的确定。最大超调量小于等于 10%,调节时间为 4S,运用超调量的计算公式,其中 为阻尼系数,有该公式可求得,阻尼系数21%0ezpd-=z=0.59,小于 1,是欠阻尼。 z,可以求得 =1.273()sntsw-为 极 点 实 部 nw则极点公式为 ,得到两个共轭极点为21,21nnpjzwz=-.1,20.75pj=-配置非主导极点 ,345,5-在 MATLAB 的控制系统工具箱中提供了单变量系统极点配置 acker(),其格式为K=acker(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)运行结果如下:4 程序及其执行结果该二阶系统的阶跃响应为下图所示脉冲响应: