% funkce pro pøevod z WGS84 do ECEF

function[ECEF_position]=WGS842ECEF(position)


fi=position(1,1)*pi./180; %zemìpisná šíøka
lambda=position(1,2)*pi./180; %zemìpisná délka
h=position(1,3);% výška nad elipsoidem
a=6378137;
e=0.0818191908425;
N=a./(sqrt(1-((e.^2.)*(sin(fi))^2)));
x=(N+h).*cos(fi).*cos(lambda);
y=(N+h).*cos(fi).*sin(lambda);
z=((1-e.^2).*N+h).*sin(fi);
ECEF_position=[x y z];

