wylicz_u2.m

Control optimisation. It is example of use BFGS algorithm to control satellite form Earth atmosphere

%   wylicza wektor u2 z podanego wektora tau i u2(tau)
function wektor_u2 = wylicz_u2 ( tau, t, u2, h0 )
global super_jednostka;
sji = super_jednostka/h0;

tau0 = [0 tau];
nr_tau = 1;

% znajdowanie punktow przelaczen:
punkty = ones(1,length(tau0));
roznice = ones(1,length(tau0));
for j=2:(length(tau0)-1)
    for i=2:length(t)
        if abs(tau0(j)-t(i))<roznice(j)
            punkty(j) = i;
            roznice(j) = tau0(j)-t(i);
        end
    end
end
punkty(length(tau0)) = length(t);

% znajdowanie punktow u(tau):
punkty_sji = [];
for j=1:2:(length(tau0)-1)
    cel = punkty(j+1);
    krok = punkty(j);
    while krok < cel;
        punkty_sji = [punkty_sji krok];
        krok = krok + sji;
    end
    punkty_sji = [punkty_sji cel];
end
if floor(length(tau0)/2)<(length(tau0)/2)
    punkty_sji = [punkty_sji length(t)];
end

% ustalanie u2:
wektor_u2 = [];
for j=1:(length(punkty_sji)-1)
    t_start = t(punkty_sji(j));
    t_koniec = t(punkty_sji(j+1));
    u_start = u2(j);
    if length(u2)>j
        u_koniec = u2(j+1);
    else
        u_koniec = u2(j);
    end
    for i=(punkty_sji(j)):(punkty_sji(j+1))
        wektor_u2(i) = u_start + (u_koniec-u_start)*(t(i)-t_start)/(t_koniec-t_start);
    end
end

end