不同坐标系经纬度转换(Java版国内通用)

package com.control.common.utils.map; /** * @Author xyange * @Version 1.0.0 * @Description //TODO * @Date 2021/12/14 13:45 **/ public class JavaRtkUtils { private double p = 206264.80624709636D; public static void main(String[] args) { // 84 118.79222222222222,32.06444444444444, // 2000 118.79232883438817,32.064499855041504, double[] cs2000ToWgs84 = cs2000ToWgs84(118.79232883438817,32.064499855041504, 3); for (double d : cs2000ToWgs84) { System.out.println(d); } double[] wgs84To2000 = wgs84To2000(118.79222222222222,32.06444444444444, 3); for (double d : wgs84To2000) { System.out.println(d); } } private double[] xyTowgs84(double x, double y, double L0) { double a = 6378137.0D; double efang = 0.0066943799901413D; double e2fang = 0.0067394967422764D; y = y - (double) 500000; double m0 = 0.0D; double m2 = 0.0D; double m4 = 0.0D; double m6 = 0.0D; double m8 = 0.0D; m0 = a * ((double) 1 - efang); m2 = 1.5D * efang * m0; m4 = efang * m2 * 5.0D / 4.0D; m6 = efang * m4 * 7.0D / 6.0D; m8 = efang * m6 * 9.0D / 8.0D; double a0 = 0.0D; double a2 = 0.0D; double a4 = 0.0D; double a6 = 0.0D; double a8 = 0.0D; a0 = m0 + m2 / 2.0D + m4 * 3.0D / 8.0D + m6 * 5.0D / 16.0D + m8 * 35.0D / 128.0D; a2 = m2 / 2.0D + m4 / 2.0D + m6 * 15.0D / 32.0D + m8 * 7.0D / 16.0D; a4 = m4 / 8.0D + m6 * 3.0D / 16.0D + m8 * 7.0D / 32.0D; a6 = m6 / 32.0D + m8 / 16.0D; a8 = m8 / 128.0D; double FBf = 0.0D; double Bf0 = x / a0; for (double Bf1 = 0.0D; Bf0 - Bf1 >= 1.0E-4D; Bf0 = (x - FBf) / a0) { Bf1 = Bf0; FBf = -a2 * Math.sin((double) 2 * Bf0) / (double) 2 + a4 * Math.sin((double) 4 * Bf0) / (double) 4 - a6 * Math.sin((double) 6 * Bf0) / (double) 6 + a8 * Math.sin((double) 8 * Bf0) / (double) 8; } double Wf = Math.sqrt((double) 1 - efang * Math.sin(Bf0) * Math.sin(Bf0)); double Nf = a / Wf; double Mf = a * ((double) 1 - efang) / Math.pow(Wf, 3.0D); double nffang = e2fang * Math.cos(Bf0) * Math.cos(Bf0); double tf = Math.tan(Bf0); double B = Bf0 - tf * y * y / ((double) 2 * Mf * Nf) + tf * ((double) 5 + (double) 3 * tf * tf + nffang - (double) 9 * nffang * tf * tf) * Math.pow(y, 4.0D) / ((double) 24 * Mf * Math.pow(Nf, 3.0D)) - tf * ((double) 61 + (double) 90 * tf * tf + (double) 45 * Math.pow(tf, 4.0D)) * Math.pow(y, 6.0D) / ((double) 720 * Mf * Math.pow(Nf, 5.0D)); double l = y / (Nf * Math.cos(Bf0)) - ((double) 1 + (double) 2 * tf * tf + nffang) * Math.pow(y, 3.0D) / ((double) 6 * Math.pow(Nf, 3.0D) * Math.cos(Bf0)) + ((double) 5 + (double) 28 * tf * tf + (double) 24 * Math.pow(tf, 4.0D)) * Math.pow(y, 5.0D) / ((double) 120 * Math.pow(Nf, 5.0D) * Math.cos(Bf0)); double L = l + L0; double[] array_B = this.rad2dms(B); double[] array_L = this.rad2dms(L); double Bdec = this.dms2dec(array_B); double Ldec = this.dms2dec(array_L); return new double[] { Bdec, Ldec }; } private double[] xyTo2000(double x, double y, double L0) { double a = 6378137.0D; double efang = 0.0066943800229008D; double e2fang = 0.0067394967422764D; y = y - (double) 500000; double m0 = 0.0D; double m2 = 0.0D; double m4 = 0.0D; double m6 = 0.0D; double m8 = 0.0D; m0 = a * ((double) 1 - efang); m2 = 1.5D * efang * m0; m4 = efang * m2 * 5.0D / 4.0D; m6 = efang * m4 * 7.0D / 6.0D; m8 = efang * m6 * 9.0D / 8.0D; double a0 = 0.0D; double a2 = 0.0D; double a4 = 0.0D; double a6 = 0.0D; double a8 = 0.0D; a0 = m0 + m2 / 2.0D + m4 * 3.0D / 8.0D + m6 * 5.0D / 16.0D + m8 * 35.0D / 128.0D; a2 = m2 / 2.0D + m4 / 2.0D + m6 * 15.0D / 32.0D + m8 * 7.0D / 16.0D; a4 = m4 / 8.0D + m6 * 3.0D / 16.0D + m8 * 7.0D / 32.0D; a6 = m6 / 32.0D + m8 / 16.0D; a8 = m8 / 128.0D; double FBf = 0.0D; double Bf0 = x / a0; for (double Bf1 = 0.0D; Bf0 - Bf1 >= 1.0E-4D; Bf0 = (x - FBf) / a0) { Bf1 = Bf0; FBf = -a2 * Math.sin((double) 2 * Bf0) / (double) 2 + a4 * Math.sin((double) 4 * Bf0) / (double) 4 - a6 * Math.sin((double) 6 * Bf0) / (double) 6 + a8 * Math.sin((double) 8 * Bf0) / (double) 8; } double Wf = Math.sqrt((double) 1 - efang * Math.sin(Bf0) * Math.sin(Bf0)); double Nf = a / Wf; double Mf = a * ((double) 1 - efang) / Math.pow(Wf, 3.0D); double nffang = e2fang * Math.cos(Bf0) * Math.cos(Bf0); double tf = Math.tan(Bf0); double B = Bf0 - tf * y * y / ((double) 2 * Mf * Nf) + tf * ((double) 5 + (double) 3 * tf * tf + nffang - (double) 9 * nffang * tf * tf) * Math.pow(y, 4.0D) / ((double) 24 * Mf * Math.pow(Nf, 3.0D)) - tf * ((double) 61 + (double) 90 * tf * tf + (double) 45 * Math.pow(tf, 4.0D)) * Math.pow(y, 6.0D) / ((double) 720 * Mf * Math.pow(Nf, 5.0D)); double l = y / (Nf * Math.cos(Bf0)) - ((double) 1 + (double) 2 * tf * tf + nffang) * Math.pow(y, 3.0D) / ((double) 6 * Math.pow(Nf, 3.0D) * Math.cos(Bf0)) + ((double) 5 + (double) 28 * tf * tf + (double) 24 * Math.pow(tf, 4.0D)) * Math.pow(y, 5.0D) / ((double) 120 * Math.pow(Nf, 5.0D) * Math.cos(Bf0)); double L = l + L0; double[] array_B = this.rad2dms(B); double[] array_L = this.rad2dms(L); double Bdec = this.dms2dec(array_B); double Ldec = this.dms2dec(array_L); return new double[] { Bdec, Ldec }; } private double gaussLongToDegreen(double B, double L, double N) { double L00 = (double) Math.round(L / (double) N) * (double) N; return L00 / (double) 180 * 3.1415926D; } private double[] rad2dms(double rad) { double[] a = new double[] { 0.0D, 0.0D, 0.0D }; double dms = rad * p; a[0] = Math.floor(dms / 3600.0D); a[1] = Math.floor((dms - a[0] * (double) 3600) / 60.0D); a[2] = (double) ((int) Math.floor(dms - a[0] * (double) 3600)) - a[1] * (double) 60; return a; } private double dms2dec(double[] dms) { double dec = 0.0D; dec = dms[0] + dms[1] / 60.0D + dms[2] / 3600.0D; return dec; } private double getL0(double B, double L, double degree,int flag){ double a = 6378137.0D; double b = flag==1?6356752.314245179D:6356752.314140355D; double e = flag==1?0.081819190842621D:0.0818191910428158D; double eC = flag==1?0.0820944379496957D:0.0820944381519172D; double L0 = 0.0D; int n; if (degree == 6.0D) { n = (int) Math.round((L + degree / (double) 2) / degree); L0 = degree * (double) n - degree / (double) 2; } else { n = (int) Math.round(L / degree); L0 = degree * (double) n; } return L0; } /** * @param flag 1 传入2000坐标转84 2 传入84坐标转2000 * @return */ private double[] GetXY(double B, double L, double degree,int flag) { double[] xy = new double[] { 0.0D, 0.0D }; double a = 6378137.0D; double b = flag==1?6356752.314245179D:6356752.314140355D; double e = flag==1?0.081819190842621D:0.0818191910428158D; double e