qftdm15b.m

机器人控制仿真程序一书的所有源代码

function qftdm15b
% Second stage of QFTDM15
%=================================

% Copyright (c) 1995-98 by The MathWorks, Inc.
%       $Revision: 1.4 $

global win1_loc win2_loc win3_loc win4_loc ...
       info_win info_str info_btn ...
       nump11 nump12 nump21 nump22 denp nom w ...
       P11 P12 P21 P22 W11 W12 W21 W22 bdb1 ubdb1 ...
       wl nc0 dc0

% close all windows from last stage and clear strings in information window
close(findobj('tag','qft'));
set(info_str,'string','');

% DESIGN
%=================================

set(info_str(1),'string','Designing G1 with LPSHAPE...');
set(info_str(2),'string','lpshape(wl,ubdb1,nL0,dL0,del0,nc0,dc0);');
drawnow

wl = logspace(-2,3,200);  % define a frequency array for loop shaping

% nominal loop
nL0=nump11(nom,:);
dL0=denp(nom,:);

% initial controller
nc0=2.0532e+6*[1,173.4,1.361077e+4,2.75809e+4,1.1270886e+5];
dc0=[1,854.43,2.5363e+5,2.87192337e+7,7.5729623405e+8,0];

lpshape(wl,ubdb1,nL0,dL0,[],nc0,dc0);

% setup for call to next stage
qftexit('qftdm15c',info_btn);