br.zuq.osm.parser.util.LatLongUtil Maven / Gradle / Ivy
package br.zuq.osm.parser.util;
public class LatLongUtil {
public static double distance(double lat1, double lon1,
double lat2, double lon2) {
Double theta = lon1 - lon2;
Double dist = (Math.sin(deg2rad(lat1))
* Math.sin(deg2rad(lat2)))
+ (Math.cos(deg2rad(lat1))
* Math.cos(deg2rad(lat2))
* Math.cos(deg2rad(theta)));
dist = Math.acos(dist);
dist = rad2deg(dist);
dist = dist * 60 * 1.1515;
dist = dist * 1.609344 * 1000;
return dist;
}
private static double deg2rad(double deg) {
return (deg * Math.PI / 180.0);
}
private static double rad2deg(double rad) {
return (rad * 180.0 / Math.PI);
}
private static double fixAngle(double angle) {
while (angle < -180) {
angle += 360;
}
while (angle > 180) {
angle -= 360;
}
return angle;
}
}