rhs.m

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

% funkcja zwracajaca prawe strony rownan stanu
function [dx] = rhs(x,t,u1,u2)
global RzRm bm c az am gz gm gs alfa02;

% rownania ruchu Ziemi:
xz = cos(az*t);
yz = sin(az*t);

% rownania ruchu Marsa:
xm = RzRm*cos((am*t)+bm);
ym = RzRm*sin((am*t)+bm);

% prawe strony rownan:
pz3 = (sqrt(((xz-x(1))^2)+((yz-x(3))^2)))^3/gz;%^3/gz
pm3 = (sqrt(((xm-x(1))^2)+((ym-x(3))^2)))^3/gm;
ps3 = (sqrt(norm([x(1),x(3)])))^3/gs;% norm

dx(1) = x(2);
dx(2) = ((xz-x(1))/pz3)+((xm-x(1))/pm3)-(x(1)/ps3)+((alfa02*u1*cos(u2))/(x(5)));%u1*a0 na zewnatrz
dx(3) = x(4);
dx(4) = ((yz-x(3))/pz3)+((ym-x(3))/pm3)-(x(3)/ps3)+((alfa02*u1*sin(u2))/(x(5)));
dx(5) = c*u1;%na zewnatrz
dx=dx';
end