两点坐标距离公式 java_地球上两点之间的距离计算（java）

package com.xagis.model;

import java.io.BufferedWriter;

import java.io.FileWriter;

import java.io.IOException;

public class Utils {

public static String BLANK= "";

public static String ZERO= "0";

private static double EARTH_RADIUS = 6378.137;

/**

* VincentyConstants

* Constants for Vincenty functions.

*/

public static double vincentyConstantA = 6378137;

public static double vincentyConstantB = 6356752.3142;

public static double vincentyConstantF = 1/298.257223563;

public static void writeTextFile(String content, String path)

throws IOException {

BufferedWriter bw = new BufferedWriter(new FileWriter(path));

bw.write(content);

bw.flush();

bw.close();

System.out.println("文件生成成功,生成目录:"+path);

}

public static String getASType(String javaType) {

if (javaType.equals("List")) {

return "ArrayCollection";

}

if (javaType.equals("boolean")) {

return "Boolean";

}

return javaType;

}

public static String lowerCaseFirstChar(String str) {

char[] c = str.toCharArray();

if (c[0] >= 'A' && c[0] <= 'Z') {

c[0] = (char) (c[0] + ('a' - 'A'));

str = new String(c);

}

return str;

}

public static String upperCaseFirstChar(String str) {

char[] c = str.toCharArray();

if (c[0] >= 'a' && c[0] <= 'z') {

c[0] = (char) (c[0] + ('A' - 'a'));

str = new String(c);

}

return str;

}

public static String getServiceName(String methodName) {

if (methodName.startsWith("get")) {

return methodName.substring(3);

} else if (methodName.startsWith("adminGet")) {

return "Admin" + methodName.substring(8);

} else {

return null;

}

}

//根据两个点坐标计算它们之间的距离(按照圆球体计算，粗略计算)

public static double getDistance(double y1, double x1, double y2, double x2)

{

double rady1 = rad(y1);

double rady2 = rad(y2);

double a = rady1 - rady2;

double b = rad(x1)-rad(x2);

double s = 2 * Math.asin(Math.sqrt(Math.pow(Math.sin(a/2),2)+Math.cos(rady1)*Math.cos(rady2)*Math.pow(Math.sin(b/2),2)));

s = s * EARTH_RADIUS;

s = (double) (Math.round(s * 10000) / 10000);

return s;

}

//转换弧度

private static double rad(double d)

{

return d*Math.PI/180.0;

}

/**

* Given two objects representing points with geographic coordinates, this

* calculates the distance between those points on the surface of an

* ellipsoid. 按照椭球体计算，精确计算

*

* Returns:

* The distance (in km) between the two input points as measured on an

* ellipsoid. Note that the input point objects must be in geographic

* coordinates (decimal degrees) and the return distance is in kilometers.

*/

public static double distVincenty(double y1, double x1, double y2, double x2)

{

double a = vincentyConstantA;

double b = vincentyConstantB;

double f = vincentyConstantF;

double L = degtoRad(x2 - x1);

double U1 = Math.atan((1-f) * Math.tan(degtoRad(y1)));

double U2 = Math.atan((1-f) * Math.tan(degtoRad(y2)));

double sinU1 = Math.sin(U1);

double cosU1 = Math.cos(U1);

double sinU2 = Math.sin(U2);

double cosU2 = Math.cos(U2);

double lambda = L;

double lambdaP = 2*Math.PI;

double iterLimit = 20;

double sinLambda = 0.0d;

double cosLambda = 0.0d;

double sinSigma = 0.0d;

double cosSigma = 0.0d;

double sigma = 0.0d;

double alpha = 0.0d;

double cosSqAlpha = 0.0d;

double cos2SigmaM = 0.0d;

double C = 0.0d;

while (Math.abs(lambda-lambdaP) > 1e-12 && --iterLimit>0) {

sinLambda = Math.sin(lambda);

cosLambda = Math.cos(lambda);

sinSigma = Math.sqrt((cosU2*sinLambda) * (cosU2*sinLambda) +

(cosU1*sinU2-sinU1*cosU2*cosLambda) * (cosU1*sinU2-sinU1*cosU2*cosLambda));

if (sinSigma==0) {

return 0; // co-incident points

}

cosSigma = sinU1*sinU2 + cosU1*cosU2*cosLambda;

sigma = Math.atan2(sinSigma, cosSigma);

alpha = Math.asin(cosU1 * cosU2 * sinLambda / sinSigma);

cosSqAlpha = Math.cos(alpha) * Math.cos(alpha);

cos2SigmaM = cosSigma - 2*sinU1*sinU2/cosSqAlpha;

C = f/16*cosSqAlpha*(4+f*(4-3*cosSqAlpha));

lambdaP = lambda;

lambda = L + (1-C) * f * Math.sin(alpha) *

(sigma + C*sinSigma*(cos2SigmaM+C*cosSigma*(-1+2*cos2SigmaM*cos2SigmaM)));

}

if (iterLimit==0) {

return 0.0; // formula failed to converge

}

double uSq = cosSqAlpha * (a*a - b*b) / (b*b);

double A = 1 + uSq/16384*(4096+uSq*(-768+uSq*(320-175*uSq)));

double B = uSq/1024 * (256+uSq*(-128+uSq*(74-47*uSq)));

double deltaSigma = B*sinSigma*(cos2SigmaM+B/4*(cosSigma*(-1+2*cos2SigmaM*cos2SigmaM)-

B/6*cos2SigmaM*(-3+4*sinSigma*sinSigma)*(-3+4*cos2SigmaM*cos2SigmaM)));

double s = b*A*(sigma-deltaSigma);

//double d = Number(s.toFixed(3))/1000; // round to 1mm precision

double d = s/1000; // round to 1mm precision

return d;

}

/**

* Convert degrees to radian

*

* @param val Value to convert

*/

public static double degtoRad(double val){

return val*Math.PI/180;

}

}