自动控制原理第12章.ppt

第十二章 控制系统设计实例分析 第十二章 控制系统设计实例分析 12.1 火炮稳定器的设计火炮稳定器的设计 12.2 船舶自动驾驶仪的设计船舶自动驾驶仪的设计 12.3 磁盘读写头的控制磁盘读写头的控制 12.4 倒立摆控制系统的设计倒立摆控制系统的设计 小小 结结第十二章 控制系统设计实例分析 12.1 火炮稳定器的设计火炮稳定器的设计 调节系统的任务是将被控量保持在设定值上, 因此调节系统设计中主要考虑的是抑制噪声坦克在行驶时,车身不停地振动,使火炮瞄准困难, 并且不能保证设计精度为了提高坦克行进时射击的效果和精度,最根本的办法是采用稳定装置 火炮稳定器可以使坦克火炮在垂直平面内保持一定的仰角φ不变(如图12-1所示) 第十二章 控制系统设计实例分析 图 12-1 火炮起落部分示意图 第十二章 控制系统设计实例分析 稳定器采用陀螺仪作为传感器陀螺仪组固定在火炮的起落部分上该陀螺仪组包括一个角度陀螺仪和一个速率陀螺仪 角度陀螺仪用来在垂直平面内建立一个稳定的指向r(即角度的设定值)当火炮的仰角φ变化时,角度陀螺仪的外框随之转动, 因而形成失调角(即角度偏差)e, 即e=r-φe=r-φ 失调角的信号由陀螺传感器送出。

速率陀螺仪是一个单自由度陀螺仪,其输出与炮身运动的角速度成比例角度陀螺和速率陀螺的信号相加, 通过执行机构(液压油缸或电机)转动火炮, 从而达到稳定的目的 第十二章 控制系统设计实例分析 图12-2是火炮稳定系统的框图,其中Kp和Kd分别表示由角度和角速度变化所给出的稳定力矩火炮的动力学特性用转动惯量J来表示,其反映了作用于火炮起落部分的力矩和角速度的关系显然这个系统采用的是PD控制规律从图12-2可以看到, 若无速率反馈,则这个二阶系统的运动方程中将缺少中间的阻尼项也就是说, 这个控制规律中的微分项是用来给系统提供阻尼的 第十二章 控制系统设计实例分析 图 12-2 火炮稳定系统结构图 第十二章 控制系统设计实例分析 图中Md为外力矩由于火炮的耳轴与轴承之间存在摩擦, 当车体振动时, 此摩擦力矩便传给火炮,使其偏离给定位置另外, 火炮起落部分的重心也不会正好在耳轴轴线上,因此车体的各种振动会造成惯性力矩所有这些力矩构成了作用于火炮的外力矩因为这个外力矩是由车体振动引起的, 故接近于正弦变化规律,即式中ωk是坦克车体纵向角振动的频率 第十二章 控制系统设计实例分析 所以坦克在行驶时相当于对火炮施加了一强迫振荡力矩, 控制系统的作用就是要抑制Md对φ的影响。

根据图12-2可以写出从Md到φ的传递函数为 (12.1) 上式表明,这个火炮稳定系统相当于一个二阶系统, 并且不希望系统的频率特性出现谐振峰值, 所以此系统的阻尼系数宜取为ζ=1 规定了阻尼系数ζ=1,实际上就是对微分项Kd作了限制 这样,系统中就只剩下一个系数Kp了这个前向控制环节的增益也称伺服刚度根据外力矩Md和允许的精度φmax, 通过简单的运算就可以确定Kp 第十二章 控制系统设计实例分析 设 火 炮 起 落 部 分 对 耳 轴 轴 线 的 转 动 惯 量 为J=350kg·m·s2, 车体振动幅度θmax=6°,振动周期为T＝1.5s,即ωk=4.2rad/s 设在这个振动参数下,车体传给起落 部 分 的 力 矩 和 惯 性 力 矩 所 合 成 的 外 力 矩 的 幅 值 为Mmax=38kg·m,允许的炮身强迫振荡的幅值为φmax=0.001rad根据ζ=1的要求和上述具体参数值,由式(12.1)得 所以, Kp的值大致为 Kp=32 000kg·m/rad 第十二章 控制系统设计实例分析 从上面的分析可以看到, 本例采用反馈控制是要在车体运动与火炮之间起到隔离作用。

即这里的火炮稳定器相当于一个隔离器本例中的隔离度大约为θmax/φmax=100，或者说隔离度等于40dB  上面结合火炮稳定器主要是要说明这类稳定系统的共同设计特点至于说到火炮稳定器, 当然还有它本身的特殊问题 注意到图12-2的系统是一个Ⅱ型系统, 传动部分的间隙不可避免地会在系统中造成自振荡 因此设计和调试中应控制其自身振荡的幅值 第十二章 控制系统设计实例分析 12.2 船舶自动驾驶仪的设计船舶自动驾驶仪的设计 船舶自动驾驶仪主要有两重任务: 航向保持和变向航行 航向保持是指在风、浪和洋流等环境扰动下将船保持在给定的航向变向是指从一个航向向另一个航向过渡时的航向控制 前者是一个调节问题,后者是一个跟踪问题 本例主要说明航向保持时自动驾驶仪的一些设计考虑 在所讨论的问题中, 船舶的数学模型可视为 第十二章 控制系统设计实例分析 式中ψ为航向角, δ为舵偏角对应的船的传递函数为 (12.2) 若采用PD控制 (12.3) 则可得系统的特征方程式(1+D(s)G(s)=0)为 (12.4) 系统的固有频率为 (12.5) 第十二章 控制系统设计实例分析 式(12.5)表明,控制规律中的比例项Kp决定了系统的固有频率,即响应速度。

而系统的阻尼特性,即式(12.4)中的第二项, 则决定于微分项Kd微分项起到了增加阻尼的作用,提高了系统的相对稳定性  船舶在航行中还受到风浪等环境的影响这些扰动都是随机的,其频谱的频率段比较高, 因此在分析中是作为高频噪声来处理的但是这些随机扰动的平均值并不一定都等于零 例如风对于航向的影响,除了随机分量以外, 往往还有一个平均力矩作用在船体上因此自动驾驶仪中还应该有一项积分项来补偿这缓慢变化的风力矩的平均值  第十二章 控制系统设计实例分析 由此可见,控制规律中PID三项都是需要的即PID控制器可以满足航向保持的控制要求明确了控制规律的组成以后, 接下来就是确定PID的各项参数参数设计常包含某种优化的概念对于船舶航行来说,不同的航行条件,有不同的要求 对于在大海上航行的商船来说,要求节省燃料这对自动驾驶仪来说, 就是要尽量减小由于操舵而引起的额外阻力当然航向误差也要小, 因为有了航向误差, 会加大船实际的航行距离 这两项要求可归纳为下列的性能指标: (12.6) 式中ε是航向误差,δ是舵偏角,λ是加权系数,并且0.1＜λ＜1.0,大船的λ可以取得小些, 小船可以取得大些。

第十二章 控制系统设计实例分析 注意到式(12.6)所表示的实际上是一种动态性能指标 由对PID三种控制作用的分析可知, 影响这一性能指标的主要是Kp和Kd,因为积分项主要是用来补偿缓慢变化的扰动力矩的 所以应该是根据性能指标首先确定Kp和Kd,然后根据系统的带宽或固有频率ωn,使Ki<<ωn来确定积分项Ki/s的系数 因为性能主要是由PD决定的, 根据式(12.2)和式(12.3), 利用线性最优控制理论, 便可求得使式(12.6)为最小的最优控制器参数为 (12.7) (12.8) 第十二章 控制系统设计实例分析 作为数字例子,设船的时间常数τ=16s, K=0.07s-1取加权系数λ=1,代入上式得最优控制器的增益为Kp=1,Kd=11.43在这组参数下,系统的固有频率为ωn=0.066 rad/s,或0.01Hz 显然,在这样的ωn下,驾驶仪功放级的时间常数以及舵机的时间常数可忽略不计这一特点对调节系统来说具有普遍性大多数调节系统中执行机构和功放级的动特性以及测量元件的动特性在系统的工作频带内均可忽略不计即在系统的工作频带内, PID就已经概括了包括执行机构在内的整个控制器的特性。

第十二章 控制系统设计实例分析 12.3 磁盘读写头的控制磁盘读写头的控制图 12-3 磁盘读写头工作原理图 第十二章 控制系统设计实例分析 运用Newton定律, 可以得出磁盘读写头的动力学模型为 其中,J是读写头的转动惯量,c是轴承的粘滞阻尼系数, K 是弹簧的刚度系数, Ki是电机力矩常数,θ表示读写头的角位移,i 是输入电流上式取拉氏变换可得系统从i到θ的传递函数为 给定系统的具体参数如下: 第十二章 控制系统设计实例分析 J=0.01kgm2, c=0.004 Nm/(rad/s)K=10Nm/rad, Ki=0.05Nm/rad使用MATLAB可以马上建立系统的传递函数模型, 相应的程序和结果如下: J = .01; C = 0.004; K = 10; Ki = .05;  num = Ki; den = ［J C K］;  H = tf(num, den)运行结果为 Transfer function:  0.05 ------------------------------------ 0.01 s^2 + 0.004 s + 10 第十二章 控制系统设计实例分析 令采样周期T＝0.005 s,并且保持器采用零阶保持器, 则可以得到系统的离散化模型, 程序如下： Ts = 0.005; % sampling period = 0.005 second Hd = c2d(H, Ts, ′zoh′) Transfer function:  6.233e-05 z + 6.229e-05 -------------------------------------  z^2 - 1.973 z + 0.998 第十二章 控制系统设计实例分析 图 12-4 磁盘读写头离散化模型的阶跃响应 第十二章 控制系统设计实例分析 为了提高系统的阻尼, 需要设计一个补偿器。

用下面语句绘制离散系统的根轨迹: rlocus(Hd); 其结果如图12-5所示由图可见，未加补偿器的系统根轨迹将很快离开单位圆,趋向无穷远处所以应该引入超前补偿器, 或含有零点的补偿器 尝试采用如下的超前补偿器： 其中,a=-0.85,b=0因此,相应的开环系统模型为D(z)Hd(z),程序如下： D=zpk(0.85,0,1,Ts); oloop = Hd * D则可以绘制引入补偿器以后系统的根轨迹图如图12-6所示, 对应的MATLAB语句为 rlocus(oloop); 第十二章 控制系统设计实例分析 图12-5 未加补偿器时系统的根轨迹图（离散情况）第十二章 控制系统设计实例分析 图 12-6 引入补偿器后系统的根轨迹图(离散情况) 第十二章 控制系统设计实例分析 在MATLAB中可以从根轨迹图上直接读出闭环极点处于某一位置时, 系统的阻尼比和相应的增益k例如取闭环极点为0.584±0.229 j, 则相应的阻尼比和开环增益为 ζ=0.781, k=4090 并且可以用下面的MATLAB语句得到闭环系统的阶跃响应曲线(见图12-8): k = 4.11e+03; cloop = feedback(oloop, k); step(cloop) 第十二章 控制系统设计实例分析 图 12-7 磁盘读写头闭环控制系统结构图 第十二章 控制系统设计实例分析 图 12-8 磁盘读写头闭环控制系统的阶跃响应 第十二章 控制系统设计实例分析 12.4 倒立摆控制系统的设计倒立摆控制系统的设计 图 12-9 倒立摆控制系统 第十二章 控制系统设计实例分析 倒立摆系统希望尽可能把摆保持在垂直的位置上,为此, 还将对小车的位置进行控制, 例如使小车作步进式的运动。

为了控制小车的位置,需要建立I型伺服系统倒立摆系统安装在小车上, 它没有积分器因此,把位置信号x(它表示小车的位置)反馈到输入端, 并且把积分器插入到前向通道中, 如图12-10所示假设倒立摆的角度θ和角速度θ都很小,则有sinθ≈θ, cosθ≈1和θθ≈0另外假设M、m和l的数值给定为 ..M=2kg, m=0.1 kg, l=0.5 m 第十二章 控制系统设计实例分析 倒立摆控制系统的动力学模型为 (12.9) (12.10) 将上述参数值代入方程(12.9)和(12.10)得 定义系统的状态变量为 第十二章 控制系统设计实例分析 把小车的位置x看作系统的输出, 并考虑图12-10可得系统的状态空间描述为 (12.11) (12.12) (12.13) (12.14) 其中， 第十二章 控制系统设计实例分析 图 12-10 倒立摆控制系统(控制对象无积分器的I型伺服系统) 第十二章 控制系统设计实例分析 为了分析方便, 可以将式(12.11)～式(12.14)改写成如下状态误差方程的形式: (12.15) 其中, 第十二章 控制系统设计实例分析 而控制信号ue为 式中, 第十二章 控制系统设计实例分析 为了使设计出的系统具有合理的响应速度和阻尼(例如希望小车在阶跃响应中的调整时间约为4～5s,最大超调量为15％～16％), 选择希望的闭环极点为s=λi(i=1, 2, 3, 4, 5)，其中， 可以验证,式(12.15)表示的系统是完全可控的, 因此可以任意配置系统的极点。

并且利用下面的MATLAB程序可以求出状态反馈增益矩阵 K : A=［0 1 0 0; 20.601 0 0 0; 0 0 0 1; -0.4905 0 0 0］; B=［0; -1; 0; 0.5］; C=［0 0 1 0］;  Ahat=［A zeros(4, 1); -C 0］; Bhat=［B; 0］;  J=［-1+j*sqrt(3) -1-j*sqrt(3) -5 -5 -5］;  Khat=acker(Ahat, Bhat, J) Khat = -157.6336 -35.3733 -56.0652 -36.7466 50.9684 ^第十二章 控制系统设计实例分析 所以有 和 确定了反馈增益矩阵K K和积分增益常数kI以后,小车位置的阶跃响应就可以通过求解下列方程得到: (12.16) 系统的输出为y=x3, 即 (12.17) 第十二章 控制系统设计实例分析 根据方程(12.16)和方程(12.17)， 可以在前面程序的基础上, 通过以下MATLAB程序求出系统的单位阶跃响应:K=Khat(1: 4); KI=-Khat(5);  AA=［A-B*K B*KI; -C 0］; BB=［0; 0; 0; 0; 1］; CC=［C 0］; DD=［0］;  t=0: 0.02: 6;  ［y, x, t］=step(AA, BB, CC, DD, 1, t); x=x′;  x1=x(1, : ); x2=x(2, : ); x3=x(3, : ); x4=x(4, : ); x5=x(5, : );  figure; plot(t, x1); grid; figure; plot(t, x2); grid; figure; plot(t, x3); grid; figure; plot(t, x4); grid; figure; plot(t, x5); grid; 第十二章 控制系统设计实例分析 图 12-11 单位阶跃信号作用下的状态响应 第十二章 控制系统设计实例分析 可见状态x3(即小车的位移x)对应的单位阶跃响应具有大约4s的调整时间,15％左右的最大超调量。

应当指出,在任何一种设计中, 如果响应速度和阻尼不能达到设计要求,就必须改变希望的极点, 并确定一个新的状态反馈矩阵 这样反复进行, 直到获得满意结果为止 第十二章 控制系统设计实例分析 小小 结结 本章给出了多个控制系统设计的实例涉及到的系统包括调节系统和伺服系统,采用的设计方法包括:经典控制理论的根轨迹法、 PID控制以及现代控制理论的极点配置方法  在给出的四个设计实例中,火炮稳定器和船舶自动驾驶仪的设计属于调节系统的设计问题, 采用的控制器是PID控制器; 磁盘读写头的控制是一个用根轨迹方法设计离散系统补偿器的例子; 最后倒立摆控制系统的设计问题采用的控制方法是极点配置法对于磁盘读写头控制器设计和倒立摆控制器设计, 本章还给出了相应的MATLAB程序和仿真结果。