xiaoyan159/vtm
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

GeoPoint: bearing calculation

Browse Source
This commit is contained in:
Andrey Novikov 2016-07-18 19:49:51 +03:00 committed by Emux
parent bb95008197
commit a8b341763e
1 changed files with 20 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

20
vtm/src/org/oscim/core/GeoPoint.java
View File

@ -1,6 +1,7 @@
/*
* Copyright 2010, 2011, 2012 mapsforge.org
* Copyright 2012 Hannes Janetzek
* Copyright 2016 Andrey Novikov
*
* This file is part of the OpenScienceMap project (http://www.opensciencemap.org).
*
@ -191,4 +192,23 @@ public class GeoPoint implements Comparable<GeoPoint> {
return (RADIUS_EARTH_METERS * tt);
}
public double bearingTo(GeoPoint other) {
return bearing(latitudeE6 / 1E6,
longitudeE6 / 1E6,
other.latitudeE6 / 1E6,
other.longitudeE6 / 1E6);
}
public static double bearing(double lat1, double lon1, double lat2, double lon2) {
double deltaLon = DEG2RAD * (lon2 - lon1);
double a1 = DEG2RAD * lat1;
double b1 = DEG2RAD * lat2;
double y = Math.sin(deltaLon) * Math.cos(b1);
double x = Math.cos(a1) * Math.sin(b1) - Math.sin(a1) * Math.cos(b1) * Math.cos(deltaLon);
double result = RAD2DEG * Math.atan2(y, x);
return (result + 360.0) % 360.0;
}
}