% close all
clc, close all, clear fig


% Definition of integer values
itg.fig = 1;
itg.lab = 1;
itg.fda = 1;
itg.axe = 1;
itg.ann = 1;
if t.tot <= 6000
    itg.xlab = 'Time $t$ [min]';
elseif  t.tot <= 3600*24
    itg.xlab = 'Time $t$ [h]';
else
    itg.xlab = 'Time $t$ [d]';
end
tStr = '\color[rgb]{1, 1, 1}titleString';

% Definition of figure and values
fig.dimw21 = 8.4;
fig.dimh21 = 12;
fig.dimw = 8.4;
fig.dimh = 6;
fig.Font = [10 8];
fig.label = [];
fig.ann   = [];

l = t.N+1;
m = 1;%2*3600/t.int+1;

for k = 1:1
    fig.in(itg.fig) = figure(itg.fig);
    set(fig.in(itg.fig),'units','centimeters','position', [5+itg.fig,5+itg.fig, fig.dimw21, fig.dimh21]);
    subplot(2,1,1)
    fig.axes(itg.axe) = gca;
    fig.axes(itg.axe).Position = [.15 .55 .775 .4];
    fig.dat(itg.fda) = plot(t.samp(m:end),Ver1.theta_int(k,m:l),'k'); itg.fda = itg.fda+1;
    hold on
    fig.dat(itg.fda) = plot(t.samp([1 end]),K_ESC.bound(k,1)*ones(1,2),'r--'); itg.fda = itg.fda+1;
    fig.dat(itg.fda) = plot(t.samp([1 end]),-K_ESC.bound(k,1)*ones(1,2),'r--'); itg.fda = itg.fda+1;
    fig.axes(itg.axe).XLim(2) = 18;
    fig.axes(itg.axe).YLim = ([-K_ESC.bound(k,1)*5 K_ESC.bound(k,1)*5]);
    fig.label(itg.lab) = ylabel(['Gradient Estimate $\hat{J}_{u_1}$']); itg.lab = itg.lab+1;
    fig.axes(itg.axe).YTickLabel = {'-1.5';'-1.0';'-0.5';'0.0';'0.5';'1.0';'1.5'};
    fig.axes(itg.axe).XTickLabel = [];
    fig.ann(itg.ann) = annotation('textbox',[0 .925 .05 .05],'String','a)'); itg.ann = itg.ann+1;
    fig.ann(itg.ann) = annotation('textbox',[.6 .79 .05 .05],'String','$J_{u_1,max}$','Color','r','horizontalAlignment', 'right'); itg.ann = itg.ann+1;
    fig.ann(itg.ann) = annotation('textbox',[.6 .66 .05 .05],'String','$-J_{u_1,max}$','Color','r','horizontalAlignment', 'right'); itg.ann = itg.ann+1;
    itg.axe = itg.axe+1;
    
    subplot(2,1,2)
    fig.axes(itg.axe) = gca;
    fig.axes(itg.axe).Position = [.15 .10 .775 .4];
%     fig.dat(itg.fda) = plot(t.samp,Ver1.p.sim(dec.dist+3,:),'k'); itg.fda = itg.fda+1;
    fig.dat(itg.fda) = plot(t.samp,Ver1.cM.set(k,:)-Ver1.cM.set(k,1),'k'); itg.fda = itg.fda+1;
    hold on
    fig.dat(itg.fda) = plot(opt.t,H{4}(1,:)*opt.y-H{4}(1,:)*opt.y(:,1),'k--'); itg.fda = itg.fda+1;
    fig.axes(itg.axe).XLim(2) = 18;
    fig.label(itg.lab) = xlabel(itg.xlab); itg.lab = itg.lab+1;
    fig.label(itg.lab) = ylabel(['Manipulated variable $\tilde{u}_1 = c_{s,1}$']); itg.lab = itg.lab+1;
    fig.ann(itg.ann) = annotation('textbox',[.29 .38 .05 .05],'String','optimal setpoint'); itg.ann = itg.ann+1;
    fig.ann(itg.ann) = annotation('textbox',[0 .475 .05 .05],'String','b)'); itg.ann = itg.ann+1;
    itg.axe = itg.axe+1;
    itg.fig = itg.fig + 1;  
    
%     fig.in(itg.fig) = figure(itg.fig);
%     set(fig.in(itg.fig),'units','centimeters','position', [5+itg.fig,5+itg.fig, fig.dimw, fig.dimh]);
%     plot(t.samp(m:end),Ver1.theta_int(k,m:l),'k')
%     fig.axes(itg.axe) = gca;
%     fig.axes(itg.axe).XLim(2) = 18;
%     itg.axe = itg.axe+1;
end


set(fig.ann, 'Interpreter', 'Latex');
set(fig.ann, 'Fontsize', 10);
set(fig.ann, 'LineStyle', 'none');
set(fig.label, 'Fontsize', fig.Font(1));
set(fig.label, 'Interpreter', 'Latex');
set(fig.axes,'FontSize', fig.Font(2));
% set(fig.axes,'Legend.FontSize', fig.Font(2));
set(fig.axes,'Box','on');
set(fig.axes,'TickLabelInterpreter', 'Latex');
set(fig.axes,'LineWidth',.75);
set(fig.axes,'XMinorTick', 'on');
set(fig.axes,'YMinorTick', 'on');
set(fig.dat,'LineWidth',.75)

%%


% for k = 1:3
%     l = t.N+1;
%     m = 2*3600/t.int+1;
%     figure(13+k)
%     subplot(2,1,1)
%     plot(t.samp(m:end),Ver1.theta_est(k,m:l),'k')
%     hold on
%     ylim([-K_ESC.bound(k,1) K_ESC.bound(k,1)])
%     subplot(2,1,2)
%     plot(t.samp,Ver1.del_u(k,:),'k')
% end