21 lines
714 B
Matlab
21 lines
714 B
Matlab
%% WGS84直角坐标系转经纬度
|
||
% 东经正数，西经为负数
|
||
% 北纬为正数，南纬为负数
|
||
% 输入参数1：纬度；输入参数2：经度；输入参数3：高度
|
||
% 经纬度单位：度；高度单位：米
|
||
function [latitude,longitude,height]=XYZ2LLA(x,y,z)
|
||
|
||
a = 6378137.0;
|
||
b = 6356752.31424518;
|
||
c = sqrt(((a * a) - (b * b)) / (a * a));
|
||
d = sqrt(((a * a) - (b * b)) / (b * b));
|
||
p = sqrt((x * x) + (y * y));
|
||
q = atan((z * a)/ (p * b));
|
||
longitude = atan(y/x);
|
||
latitude = atan((z + (d * d) * b * sin(q)^3)/(p - (c * c) * a * cos(q)^3));
|
||
N = a / sqrt(1 - ((c * c) * sin(latitude)^2));
|
||
height = (p / cos(latitude)) - N;
|
||
longitude = longitude * 180.0 / pi+180;
|
||
latitude = latitude * 180.0 / pi;
|
||
end
|
||
|