35 lines
637 B
Mathematica
35 lines
637 B
Mathematica
|
%%
|
||
|
|
clear; close all; clc;
|
||
|
|
|
||
|
|
%% Load Plant
|
||
|
|
load('./mat/G_f_to_d.mat', 'G_20');
|
||
|
|
|
||
|
|
%% Load previously generated controllers
|
||
|
|
load('./mat/control_K_tx.mat', 'K_tx');
|
||
|
|
load('./mat/control_K_ty.mat', 'K_ty');
|
||
|
|
load('./mat/control_K_tz.mat', 'K_tz');
|
||
|
|
|
||
|
|
%%
|
||
|
|
sisotool('bode', G_20(1, 1), K_tx);
|
||
|
|
K_tx = C;
|
||
|
|
save('./mat/control_K_tx.mat', 'K_tx');
|
||
|
|
|
||
|
|
%%
|
||
|
|
sisotool('bode', G_20(2, 2), K_ty);
|
||
|
|
K_ty = C;
|
||
|
|
save('./mat/control_K_ty.mat', 'K_ty');
|
||
|
|
|
||
|
|
%%
|
||
|
|
sisotool('bode', G_20(3, 3), K_tz);
|
||
|
|
K_tz = C;
|
||
|
|
save('./mat/control_K_tz.mat', 'K_tz');
|
||
|
|
|
||
|
|
%%
|
||
|
|
K = tf(zeros(6));
|
||
|
|
K(1,1) = K_tx;
|
||
|
|
K(2,2) = K_ty;
|
||
|
|
K(3,3) = K_tz;
|
||
|
|
|
||
|
|
%% Save the MIMO control
|
||
|
|
save('./mat/controller.mat', 'K');
|