daj_q.m

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

% funkcja celu:
% wejscia:
%	T - czas koncowy
%   xmT, ymT - polozenie Marsa w czasie T
%   dxmT, dymT - predkosc Marsa w czasie T
% wyjscie:
%   q - wartosc odzwieciedlajaca jakosc sterowania
function q = daj_q(T,xmT,ymT,dxmT,dymT,xT)
global kq;

q1 = kq(1)*( (xmT-xT(1))^2 );
q2 = kq(2)*( (dxmT-xT(2))^2 );
q3 = kq(3)*( (ymT-xT(3))^2 );
q4 = kq(4)*( (dymT-xT(4))^2 );
q5 = kq(5)*xT(5);

q = 0.5*(q1 + q2 + q3 + q4) - q5;

end     % koniec funkcji