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

Fix route calculation

Browse source
This commit is contained in:
Victor Shcherb 2020-06-29 18:48:03 +02:00
parent a4cf6649b5
commit 284a007189
1 changed files with 41 additions and 19 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

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

@ -52,12 +52,26 @@ public class RoutePlannerFrontEnd {
public int routeDistCalculations = 0; public int routeDistCalculations = 0;
public List<RouteSegmentResult> res = new ArrayList<RouteSegmentResult>(); public List<RouteSegmentResult> res = new ArrayList<RouteSegmentResult>();
public int routeDistance; public int routeDistance;
public int routeDistanceDisconnected; public int routeDistanceUnmatched;
@Override @Override
public String toString() { public String toString() {
return String.format(">> GPX approximation (%d of %d m route calcs, %d route points searched) for %d m: %d m disconnected", return String.format(">> GPX approximation (%d of %d m route calcs, %d route points searched) for %d m: %d m umatched",
routeCalculations, routeDistCalculations, routePointsSearched, routeDistance, routeDistanceDisconnected); routeCalculations, routeDistCalculations, routePointsSearched, routeDistance, routeDistanceUnmatched);
}
public double distFromLastPoint(LatLon startPoint) {
if(res.size() > 0) {
return MapUtils.getDistance(getLastPoint(), startPoint);
}
return 0;
}
public LatLon getLastPoint() {
if(res.size() > 0) {
return res.get(res.size() - 1).getEndPoint();
}
return null;
} }
} }
@ -185,6 +199,7 @@ public class RoutePlannerFrontEnd {
// TODO not correct bicycle-> pedestrian // TODO not correct bicycle-> pedestrian
// TODO slow - too many findRouteSegment // TODO slow - too many findRouteSegment
// TODO fix progress / timings routing / // TODO fix progress / timings routing /
// TODO smoothen straight line Douglas-Peucker (remove noise)
public GpxApproximationResult searchGpxRoute(final RoutingContext ctx, List<LatLon> points) throws IOException, InterruptedException { public GpxApproximationResult searchGpxRoute(final RoutingContext ctx, List<LatLon> points) throws IOException, InterruptedException {
GpxApproximationResult gctx = new GpxApproximationResult(); GpxApproximationResult gctx = new GpxApproximationResult();
List<GpxPoint> gpxPoints = generageGpxPoints(points, gctx); List<GpxPoint> gpxPoints = generageGpxPoints(points, gctx);
@ -231,16 +246,22 @@ public class RoutePlannerFrontEnd {
RouteRegion reg = new RouteRegion(); RouteRegion reg = new RouteRegion();
reg.initRouteEncodingRule(0, "highway", "unmatched"); reg.initRouteEncodingRule(0, "highway", "unmatched");
TIntArrayList lastStraightLine = null; TIntArrayList lastStraightLine = null;
for (int i = 0; i < gpxPoints.size() - 1; ) { for (int i = 0; i < gpxPoints.size(); ) {
GpxPoint pnt = gpxPoints.get(i); GpxPoint pnt = gpxPoints.get(i);
if (pnt.routeToTarget != null && !pnt.routeToTarget.isEmpty()) { if (pnt.routeToTarget != null && !pnt.routeToTarget.isEmpty()) {
LatLon startPoint = pnt.routeToTarget.get(0).getStartPoint();
if (lastStraightLine != null) { if (lastStraightLine != null) {
addStraightLine(gctx.res, lastStraightLine, reg); lastStraightLine.add(MapUtils.get31TileNumberX(startPoint.getLongitude()));
lastStraightLine.add(MapUtils.get31TileNumberY(startPoint.getLatitude()));
addStraightLine(gctx.res, lastStraightLine, reg, gctx);
lastStraightLine = null; lastStraightLine = null;
} }
if (gctx.res.size() > 0 // TODO
&& MapUtils.getDistance(pnt.routeToTarget.get(0).getStartPoint(), gctx.res.get(gctx.res.size() - 1).getEndPoint()) > 30) { double distLastPnt = gctx.distFromLastPoint(pnt.routeToTarget.get(0).getStartPoint());
System.out.println("?????"); double gpxDistPnt = gctx.distFromLastPoint(pnt.loc);
if (distLastPnt > MINIMUM_POINT_APPROXIMATION / 5 || gpxDistPnt > MINIMUM_POINT_APPROXIMATION / 5) {
System.out.println(String.format("????? routePnt - prevPnt = %f, gpxPoint - prevPnt = %f ",
distLastPnt, gpxDistPnt));
} }
gctx.res.addAll(pnt.routeToTarget); gctx.res.addAll(pnt.routeToTarget);
i = pnt.targetInd; i = pnt.targetInd;
@ -248,22 +269,19 @@ public class RoutePlannerFrontEnd {
// add straight line from i -> i+1 // add straight line from i -> i+1
if (lastStraightLine == null) { if (lastStraightLine == null) {
lastStraightLine = new TIntArrayList(); lastStraightLine = new TIntArrayList();
lastStraightLine.add(MapUtils.get31TileNumberX(pnt.loc.getLongitude())); // make smooth connection
lastStraightLine.add(MapUtils.get31TileNumberY(pnt.loc.getLatitude())); if(gctx.distFromLastPoint(pnt.loc) > 1) {
if (gctx.res.size() > 0 lastStraightLine.add(MapUtils.get31TileNumberX(gctx.getLastPoint().getLongitude()));
&& MapUtils.getDistance(pnt.loc, gctx.res.get(gctx.res.size() - 1).getEndPoint()) > 30) { lastStraightLine.add(MapUtils.get31TileNumberY(gctx.getLastPoint().getLatitude()));
System.out.println("???");
} }
} }
GpxPoint nxt = gpxPoints.get(i + 1); lastStraightLine.add(MapUtils.get31TileNumberX(pnt.loc.getLongitude()));
lastStraightLine.add(MapUtils.get31TileNumberX(nxt.loc.getLongitude())); lastStraightLine.add(MapUtils.get31TileNumberY(pnt.loc.getLatitude()));
lastStraightLine.add(MapUtils.get31TileNumberY(nxt.loc.getLatitude()));
gctx.routeDistanceDisconnected += (nxt.cumDist - pnt.cumDist);
i++; i++;
} }
} }
if (lastStraightLine != null) { if (lastStraightLine != null) {
addStraightLine(gctx.res, lastStraightLine, reg); addStraightLine(gctx.res, lastStraightLine, reg, gctx);
lastStraightLine = null; lastStraightLine = null;
} }
// clean turns to recaculate them // clean turns to recaculate them
@ -310,7 +328,7 @@ public class RoutePlannerFrontEnd {
preparation.prepareTurnResults(ctx, gctx.res); preparation.prepareTurnResults(ctx, gctx.res);
} }
private void addStraightLine(List<RouteSegmentResult> res, TIntArrayList lastStraightLine, RouteRegion reg) { private void addStraightLine(List<RouteSegmentResult> res, TIntArrayList lastStraightLine, RouteRegion reg, GpxApproximationResult gctx) {
RouteDataObject rdo = new RouteDataObject(reg); RouteDataObject rdo = new RouteDataObject(reg);
int l = lastStraightLine.size() / 2; int l = lastStraightLine.size() / 2;
rdo.pointsX = new int[l]; rdo.pointsX = new int[l];
@ -320,6 +338,10 @@ public class RoutePlannerFrontEnd {
for (int i = 0; i < l; i++) { for (int i = 0; i < l; i++) {
rdo.pointsX[i] = lastStraightLine.get(i * 2); rdo.pointsX[i] = lastStraightLine.get(i * 2);
rdo.pointsY[i] = lastStraightLine.get(i * 2 + 1); rdo.pointsY[i] = lastStraightLine.get(i * 2 + 1);
if(i > 0) {
double dist = MapUtils.squareRootDist31(rdo.pointsX[i], rdo.pointsY[i], rdo.pointsX[i-1], rdo.pointsY[i-1]);
gctx.routeDistanceUnmatched += dist;
}
} }
res.add(new RouteSegmentResult(rdo, 0, rdo.getPointsLength() - 1)); res.add(new RouteSegmentResult(rdo, 0, rdo.getPointsLength() - 1));
} }