public static StreetNode findNearestNode(StreetGraph g, double lat, double lng) {
StreetNode best = null;
double bestDistance = Double.POSITIVE_INFINITY;
for (StreetNode n : g.getAllNodes()) {
double newDistance = DistanceHelper.distance(lat, lng, n.getLatitude(), n.getLongitude());
if (best == null || newDistance < bestDistance) {
bestDistance = newDistance;
best = n;
}
}
return best;
}
public static Float calcDistance(StreetNode n1, StreetNode n2) {
return (float)
DistanceHelper.fastDistance(
n1.getLatitude(), n1.getLongitude(), n2.getLatitude(), n2.getLongitude());
}
