空间直角坐标系坐标 - 空间大地坐标系坐标(XYZ-BLH)正反算

/ *

* 计算椭球的卯酉圈曲率半径(单位:m)

* /

public static double getN(double B) {

double a = 6378.137 * 1000;

double b = 6356.7523141 * 1000;

BigDecimal a1 = new BigDecimal(Double.toString(a));

BigDecimal b1 = new BigDecimal(Double.toString(b));

BigDecimal B1 = new BigDecimal(Double.toString(B));

BigDecimal cosB1 = new BigDecimal(Double.toString(Math.cos(B1 .doubleValue())));

BigDecimal one = new BigDecimal(Double.toString(1));

BigDecimal e1 = new BigDecimal(Double.toString(a1.multiply(a1) .subtract(b1.multiply(b1)).divide(a1.multiply(a1), 100,

BigDecimal.ROUND_HALF_UP).doubleValue()));

BigDecimal W1 = new BigDecimal(Double.toString(Math.sqrt((one .subtract(e1.multiply(one.subtract(cosB1.multiply(cosB1))))) .doubleValue())));

BigDecimal N1 = new BigDecimal(Double.toString(a1.divide(W1, 100, BigDecimal.ROUND_HALF_UP).doubleValue()));

return N1.doubleValue();

}

/*

* 空间大地坐标系转换空间直角坐标系(单位:m)

*/

public static void GeodeticForCartesian(double B, double L, double H) {

double a = 6378.137 * 1000;

double b = 6356.7523141 * 1000;

double iPI = 0.0174532925199433;// (π/180.0)

BigDecimal a1 = new BigDecimal(Double.toString(a));

BigDecimal b1 = new BigDecimal(Double.toString(b));

BigDecimal B1 = new BigDecimal(Double.toString(B * iPI));

BigDecimal L1 = new BigDecimal(Double.toString(L * iPI));

BigDecimal H1 = new BigDecimal(Double.toString(H));

BigDecimal one = new BigDecimal(Double.toString(1));

BigDecimal e1 = new BigDecimal(Double.toString(a1.multiply(a1) .subtract(b1.multiply(b1)).divide(a1.multiply(a1), 100,

BigDecimal.ROUND_HALF_UP).doubleValue()));

BigDecimal cosB1 = new BigDecimal(Double.toString(Math.cos(B1 .doubleValue())));

BigDecimal sinB1 = new BigDecimal(Double.toString(Math.sin(B1 .doubleValue())));

BigDecimal cosL1 = new BigDecimal(Double.toString(Math.cos(L1 .doubleValue())));

BigDecimal sinL1 = new BigDecimal(Double.toString(Math.sin(L1 .doubleValue())));

BigDecimal N = new

BigDecimal(Double.toString(getN(B1.doubleValue())));

double X = N.add(H1).multiply(cosB1).multiply(cosL1).doubleValue();

double Y = N.add(H1).multiply(cosB1).multiply(sinL1).doubleValue();

double Z = new

BigDecimal(Double.toString(N.multiply(one.subtract(e1))

.add(H1).doubleValue())).multiply(sinB1).doubleValue();

CartesianForGeodetic(X, Y, Z);

}

/*

* 空间直角坐标系转换空间大地坐标系(单位:m)

*/

public static void CartesianForGeodetic(double X, double Y, double Z) {

double a = 6378.137 * 1000;

double b = 6356.7523141 * 1000;

double e = ((a * a) - (b * b)) / (a * a);

double iPI = 0.0174532925199433;// (π/180.0)

double B;

double H;

double N, tH, lB;

double tB = Math.atan(Z / Math.sqrt(((X * X) + (Y * Y))));

// 迭代算法

while (true) {

N = getN(tB);

tH = Math.sqrt((X * X) + (Y * Y)) / Math.cos(tB) - N;

lB = Math.atan((Z + (N * e * Math.sin(tB)))

/ Math.sqrt((X * X) + (Y * Y)));

if (Math.abs(lB - tB) > 1E-99) {

tB = lB;

} else {

B = lB;

N = getN(B);

H = Math.sqrt((X * X) + (Y * Y)) / Math.cos(B) - N;

break;

}

}

B = B / iPI;

double L = ((3.14159265358989) + Math.atan(Y / X))

* (180 / 3.14159265358989);

}