You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
12 lines
418 B
12 lines
418 B
7 years ago
|
function posNED = LLH2NED(LLH,refLLH)
|
||
|
|
|
||
|
|
radius = 6378137;
|
||
|
|
flattening = 1/298.257223563;
|
||
|
|
e = sqrt(flattening*(2-flattening));
|
||
|
|
Rm = radius*(1-e^2)/(1-e^2*sin(refLLH(1)*pi/180)^2)^(3/2);
|
||
|
|
Rn = radius/(1-e^2*sin(refLLH(1)*pi/180)^2)^(1/2);
|
||
|
|
posN = (LLH(1,:)-refLLH(1))*pi/180.*(Rm+LLH(3,:));
|
||
|
|
posE = (LLH(2,:)-refLLH(2))*pi/180.*(Rn+LLH(3,:))*cos(refLLH(1)*pi/180);
|
||
|
|
posD = -(LLH(3,:)-refLLH(3));
|
||
|
|
posNED = [posN;posE;posD];
|
||
8 years ago
|
end
|