Android-builders-club/OsmAnd
1
0
Fork 0
Code Issues Pull requests Projects Releases Wiki Activity

Add gpx approximation

Browse source
This commit is contained in:
Victor Shcherb 2020-06-26 19:26:44 +02:00
parent 61f6b93d18
commit 90b2814faa
1 changed files with 109 additions and 1 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

110
OsmAnd-java/src/main/java/net/osmand/router/RoutePlannerFrontEnd.java
View file

@ -30,6 +30,10 @@ public class RoutePlannerFrontEnd {
protected static final double GPS_POSSIBLE_ERROR = 7;
public boolean useSmartRouteRecalculation = true;
public static double AVERAGE_SPLIT_DISTANCE_GPX = 500;
public static double MINIMUM_SPLIT_DISTANCE_GPX = 100;
public static double DISTANCE_APPROXIMATE_THRESHOLD = 50;
public RoutePlannerFrontEnd() {
}
@ -147,6 +151,110 @@ public class RoutePlannerFrontEnd {
useSmartRouteRecalculation = use;
}
private static class GpxApproximateContext {
int routeCalculations = 0;
double routeDistCalculations = 0;
}
private static class GpxPoint {
public int ind;
public LatLon loc;
public double cumDist;
public RouteSegmentPoint pnt;
public List<RouteSegmentResult> routeToTarget;
public int targetInd = -1;
}
public List<RouteSegmentResult> searchGpxRoute(final RoutingContext ctx, List<LatLon> points) throws IOException, InterruptedException {
GpxApproximateContext gctx = new GpxApproximateContext();
List<GpxPoint> gpxPoints = new ArrayList<>(points.size());
GpxPoint prev = null;
int firstInd = gpxPoints.size();
for(int i = 0; i < points.size(); i++) {
GpxPoint p = new GpxPoint();
p.ind = i;
p.loc = points.get(i);
if (prev != null) {
p.cumDist = MapUtils.getDistance(p.loc, prev.loc) + prev.cumDist;
}
if (firstInd == gpxPoints.size()) {
p.pnt = findRouteSegment(p.loc.getLatitude(), p.loc.getLongitude(), ctx, null, false);
if(p.pnt != null) {
firstInd = i;
}
}
gpxPoints.add(p);
prev = p;
}
while (firstInd < gpxPoints.size() - 1) {
int nextInd = findGpxRouteFromPoint(ctx, gctx, gpxPoints, firstInd);
if(nextInd == -1) {
firstInd++;
} else {
firstInd = nextInd;
}
}
List<RouteSegmentResult> res = new ArrayList<RouteSegmentResult>();
for (int i = 0; i < gpxPoints.size() - 1; i++) {
GpxPoint pnt = gpxPoints.get(i);
if (pnt.routeToTarget != null && !pnt.routeToTarget.isEmpty()) {
res.addAll(pnt.routeToTarget);
i = pnt.targetInd;
} else {
// TODO add straight line from i -> i+1
// res.add(new RouteSegmentResult(new RouteDataObject(null)));
}
}
if (!res.isEmpty()) {
System.out.println(String.format("GPX route approximations was found by %d of %f m route calculations for %f distance",
gctx.routeCalculations, gctx.routeDistCalculations, gpxPoints.get(gpxPoints.size() - 1).cumDist));
new RouteResultPreparation().printResults(ctx, points.get(0), points.get(points.size() - 1), res);
}
return res;
}
private int findGpxRouteFromPoint(final RoutingContext ctx, GpxApproximateContext gctx, List<GpxPoint> gpxPoints,
int pointFrom) throws IOException, InterruptedException {
GpxPoint start = gpxPoints.get(pointFrom);
for (int targetInd = gpxPoints.size() - 1; targetInd > pointFrom; targetInd--) {
GpxPoint target = gpxPoints.get(targetInd);
if (target.cumDist - start.cumDist < AVERAGE_SPLIT_DISTANCE_GPX) {
target.pnt = findRouteSegment(target.loc.getLatitude(), target.loc.getLongitude(), ctx, null, false);
List<RouteSegmentResult> res = null;
if (target.pnt != null) {
gctx.routeDistCalculations += (target.cumDist - start.cumDist);
gctx.routeCalculations++;
res = searchRouteInternalPrepare(ctx, start.pnt, target.pnt, null);
} else if (target.cumDist - start.cumDist < MINIMUM_SPLIT_DISTANCE_GPX) {
// distance too short, so break here and leave non-built
return targetInd;
}
boolean routeIsCorrect = res != null && res.isEmpty();
for (int k = pointFrom + 1; k < targetInd; k++) {
GpxPoint ipoint = gpxPoints.get(k);
if (dist(ipoint, res) > DISTANCE_APPROXIMATE_THRESHOLD) {
routeIsCorrect = false;
targetInd = k;
break;
}
}
if (routeIsCorrect) {
start.routeToTarget = res;
start.targetInd = target.ind;
makeStartEndPointsPrecise(res, start.pnt.getPreciseLatLon(), target.pnt.getPreciseLatLon(), null);
return targetInd;
}
}
}
return -1;
}
private double dist(GpxPoint ipoint, List<RouteSegmentResult> res) {
// TODO Auto-generated method stub
return 0;
}
private boolean needRequestPrivateAccessRouting(RoutingContext ctx, List<LatLon> points) throws IOException {
boolean res = false;
@ -510,7 +618,7 @@ public class RoutePlannerFrontEnd {
ctx.relaxedSegments += local.relaxedSegments;
ctx.routingTime += local.routingTime;
local.unloadAllData(ctx);
// local.unloadAllData(ctx);
if (restPartRecalculatedRoute != null) {
results.addAll(restPartRecalculatedRoute);
break;