%funkce pøevodu ze souøadnicového systému WGS84 do ECEF

function [x,y,z] = WGS2ECEF(lat,long,h)
fi=lat*pi./180; %zemìpisná šíøka
lambda=long*pi./180; %zemìpisná déla
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);
end

