| | | 1 | | using System; |
| | | 2 | | using System.Collections.Generic; |
| | | 3 | | using System.Linq; |
| | | 4 | | using Itinero.Geo; |
| | | 5 | | using Itinero.Network.Attributes; |
| | | 6 | | |
| | | 7 | | namespace Itinero.Routes; |
| | | 8 | | |
| | | 9 | | /// <summary> |
| | | 10 | | /// Contains extensions for the route object. |
| | | 11 | | /// </summary> |
| | | 12 | | public static class RouteExtensions |
| | | 13 | | { |
| | | 14 | | /// <summary> |
| | | 15 | | /// Concatenates two routes. |
| | | 16 | | /// </summary> |
| | | 17 | | public static Route Concatenate(this Route route1, Route route2) |
| | 0 | 18 | | { |
| | 0 | 19 | | return route1.Concatenate(route2, true); |
| | 0 | 20 | | } |
| | | 21 | | |
| | | 22 | | /// <summary> |
| | | 23 | | /// Concatenates two routes. |
| | | 24 | | /// </summary> |
| | | 25 | | public static Route Concatenate(this Route route1, Route route2, bool clone) |
| | 0 | 26 | | { |
| | 0 | 27 | | if (route1 == null) |
| | 0 | 28 | | { |
| | 0 | 29 | | return route2; |
| | | 30 | | } |
| | | 31 | | |
| | 0 | 32 | | if (route2 == null) |
| | 0 | 33 | | { |
| | 0 | 34 | | return route1; |
| | | 35 | | } |
| | | 36 | | |
| | 0 | 37 | | if (route1.Shape == null || route1.Shape.Count == 0) |
| | 0 | 38 | | { |
| | 0 | 39 | | return route2; |
| | | 40 | | } |
| | | 41 | | |
| | 0 | 42 | | if (route2.Shape == null || route2.Shape.Count == 0) |
| | 0 | 43 | | { |
| | 0 | 44 | | return route1; |
| | | 45 | | } |
| | | 46 | | |
| | 0 | 47 | | var timeoffset = route1.TotalTime; |
| | 0 | 48 | | var distanceoffset = route1.TotalDistance; |
| | 0 | 49 | | var shapeoffset = route1.Shape.Count - 1; |
| | | 50 | | |
| | | 51 | | // merge shape. |
| | 0 | 52 | | var shapeLength = route1.Shape.Count + route2.Shape.Count - 1; |
| | 0 | 53 | | var shape = new (double longitude, double latitude, float? e)[route1.Shape.Count + route2.Shape.Count - 1]; |
| | 0 | 54 | | route1.Shape.CopyTo(shape, 0); |
| | 0 | 55 | | route2.Shape.CopyTo(shape, route1.Shape.Count - 1); |
| | | 56 | | |
| | | 57 | | // merge metas. |
| | 0 | 58 | | var metas1 = route1.ShapeMeta?.Count ?? 0; |
| | 0 | 59 | | var metas2 = route2.ShapeMeta?.Count ?? 0; |
| | 0 | 60 | | Route.Meta[]? metas = null; |
| | 0 | 61 | | if (metas1 + metas2 - 1 > 0) |
| | 0 | 62 | | { |
| | 0 | 63 | | metas = new Route.Meta[metas1 + metas2 - 1]; |
| | 0 | 64 | | if (route1.ShapeMeta != null) |
| | 0 | 65 | | { |
| | 0 | 66 | | for (var i = 0; i < route1.ShapeMeta.Count; i++) |
| | 0 | 67 | | { |
| | 0 | 68 | | metas[i] = new Route.Meta |
| | 0 | 69 | | { |
| | 0 | 70 | | Attributes = new List<(string key, string value)>(route1.ShapeMeta[i].Attributes), |
| | 0 | 71 | | Shape = route1.ShapeMeta[i].Shape |
| | 0 | 72 | | }; |
| | 0 | 73 | | } |
| | 0 | 74 | | } |
| | | 75 | | |
| | 0 | 76 | | if (route2.ShapeMeta != null) |
| | 0 | 77 | | { |
| | 0 | 78 | | for (var i = 1; i < route2.ShapeMeta.Count; i++) |
| | 0 | 79 | | { |
| | 0 | 80 | | metas[metas1 + i - 1] = new Route.Meta |
| | 0 | 81 | | { |
| | 0 | 82 | | Attributes = new List<(string key, string value)>(route2.ShapeMeta[i].Attributes), |
| | 0 | 83 | | Shape = route2.ShapeMeta[i].Shape + shapeoffset, |
| | 0 | 84 | | Distance = route2.ShapeMeta[i].Distance + distanceoffset, |
| | 0 | 85 | | Time = route2.ShapeMeta[i].Time + timeoffset |
| | 0 | 86 | | }; |
| | 0 | 87 | | } |
| | 0 | 88 | | } |
| | 0 | 89 | | } |
| | | 90 | | |
| | | 91 | | // merge stops. |
| | 0 | 92 | | var stops = new List<Route.Stop>(); |
| | 0 | 93 | | if (route1.Stops != null) |
| | 0 | 94 | | { |
| | 0 | 95 | | for (var i = 0; i < route1.Stops.Count; i++) |
| | 0 | 96 | | { |
| | 0 | 97 | | var stop = route1.Stops[i]; |
| | 0 | 98 | | stops.Add(new Route.Stop |
| | 0 | 99 | | { |
| | 0 | 100 | | Attributes = new List<(string key, string value)>(stop.Attributes), |
| | 0 | 101 | | Coordinate = stop.Coordinate, |
| | 0 | 102 | | Shape = stop.Shape |
| | 0 | 103 | | }); |
| | 0 | 104 | | } |
| | 0 | 105 | | } |
| | | 106 | | |
| | 0 | 107 | | if (route2.Stops != null) |
| | 0 | 108 | | { |
| | 0 | 109 | | for (var i = 0; i < route2.Stops.Count; i++) |
| | 0 | 110 | | { |
| | 0 | 111 | | var stop = route2.Stops[i]; |
| | 0 | 112 | | if (i == 0 && stops.Count > 0) |
| | 0 | 113 | | { // compare with last stop to remove duplicates. |
| | 0 | 114 | | var existing = stops[stops.Count - 1]; |
| | 0 | 115 | | if (existing.Shape == route1.Shape.Count - 1 && |
| | 0 | 116 | | Math.Abs(existing.Coordinate.latitude - stop.Coordinate.latitude) < double.Epsilon && |
| | 0 | 117 | | Math.Abs(existing.Coordinate.longitude - stop.Coordinate.longitude) < double.Epsilon && |
| | 0 | 118 | | existing.Attributes.ContainsSame(stop.Attributes, "time", "distance")) |
| | 0 | 119 | | { |
| | | 120 | | // stop are identical, stop this one. |
| | 0 | 121 | | continue; |
| | | 122 | | } |
| | 0 | 123 | | } |
| | | 124 | | |
| | 0 | 125 | | stops.Add(new Route.Stop |
| | 0 | 126 | | { |
| | 0 | 127 | | Attributes = new List<(string key, string value)>(stop.Attributes), |
| | 0 | 128 | | Coordinate = stop.Coordinate, |
| | 0 | 129 | | Shape = stop.Shape + shapeoffset |
| | 0 | 130 | | }); |
| | 0 | 131 | | stops[stops.Count - 1].Distance = stop.Distance + distanceoffset; |
| | 0 | 132 | | stops[stops.Count - 1].Time = stop.Time + timeoffset; |
| | 0 | 133 | | } |
| | 0 | 134 | | } |
| | | 135 | | |
| | | 136 | | // merge branches. |
| | 0 | 137 | | var branches1 = route1.Branches?.Length ?? 0; |
| | 0 | 138 | | var branches2 = route2.Branches?.Length ?? 0; |
| | 0 | 139 | | var branches = new Route.Branch[branches1 + branches2]; |
| | 0 | 140 | | if (branches1 + branches2 > 0) |
| | 0 | 141 | | { |
| | 0 | 142 | | if (route1.Branches != null) |
| | 0 | 143 | | { |
| | 0 | 144 | | for (var i = 0; i < route1.Branches.Length; i++) |
| | 0 | 145 | | { |
| | 0 | 146 | | var branch = route1.Branches[i]; |
| | 0 | 147 | | branches[i] = new Route.Branch |
| | 0 | 148 | | { |
| | 0 | 149 | | Attributes = new List<(string key, string value)>(branch.Attributes), |
| | 0 | 150 | | Coordinate = branch.Coordinate, |
| | 0 | 151 | | Shape = branch.Shape |
| | 0 | 152 | | }; |
| | 0 | 153 | | } |
| | 0 | 154 | | } |
| | | 155 | | |
| | 0 | 156 | | if (route2.Branches != null) |
| | 0 | 157 | | { |
| | 0 | 158 | | for (var i = 0; i < route2.Branches.Length; i++) |
| | 0 | 159 | | { |
| | 0 | 160 | | var branch = route2.Branches[i]; |
| | 0 | 161 | | branches[branches1 + i] = new Route.Branch |
| | 0 | 162 | | { |
| | 0 | 163 | | Attributes = new List<(string key, string value)>(branch.Attributes), |
| | 0 | 164 | | Coordinate = branch.Coordinate, |
| | 0 | 165 | | Shape = branch.Shape + shapeoffset |
| | 0 | 166 | | }; |
| | 0 | 167 | | } |
| | 0 | 168 | | } |
| | 0 | 169 | | } |
| | | 170 | | |
| | | 171 | | // merge attributes. |
| | 0 | 172 | | var attributes = new List<(string key, string value)>(route1.Attributes); |
| | 0 | 173 | | attributes.AddOrReplace(route2.Attributes); |
| | 0 | 174 | | var profile = route1.Profile; |
| | 0 | 175 | | if (route2.Profile != profile) |
| | 0 | 176 | | { |
| | 0 | 177 | | attributes.RemoveKey("profile"); |
| | 0 | 178 | | } |
| | | 179 | | |
| | | 180 | | // update route. |
| | 0 | 181 | | var route = new Route |
| | 0 | 182 | | { |
| | 0 | 183 | | Attributes = attributes, |
| | 0 | 184 | | Branches = branches, |
| | 0 | 185 | | Shape = shape.ToList(), |
| | 0 | 186 | | ShapeMeta = metas.ToList(), |
| | 0 | 187 | | Stops = stops, |
| | 0 | 188 | | TotalDistance = route1.TotalDistance + route2.TotalDistance, |
| | 0 | 189 | | TotalTime = route1.TotalTime + route2.TotalTime |
| | 0 | 190 | | }; |
| | 0 | 191 | | return route; |
| | 0 | 192 | | } |
| | | 193 | | |
| | | 194 | | /// <summary> |
| | | 195 | | /// Concatenates all the given routes or returns an error when one of the routes cannot be concatenated. |
| | | 196 | | /// </summary> |
| | | 197 | | /// <param name="routes"></param> |
| | | 198 | | /// <returns></returns> |
| | | 199 | | public static Result<Route> Concatenate(this IEnumerable<Result<Route>> routes) |
| | 0 | 200 | | { |
| | 0 | 201 | | Route? route = null; |
| | 0 | 202 | | var r = 0; |
| | 0 | 203 | | foreach (var localRoute in routes) |
| | 0 | 204 | | { |
| | 0 | 205 | | if (localRoute.IsError) |
| | 0 | 206 | | { |
| | 0 | 207 | | return new Result<Route>($"Route at index {r} is in error: {localRoute.ErrorMessage}"); |
| | | 208 | | } |
| | | 209 | | |
| | 0 | 210 | | route = route == null ? localRoute.Value : route.Concatenate(localRoute.Value); |
| | | 211 | | |
| | 0 | 212 | | r++; |
| | 0 | 213 | | } |
| | | 214 | | |
| | 0 | 215 | | return new Result<Route>(route); |
| | 0 | 216 | | } |
| | | 217 | | |
| | | 218 | | // /// <summary> |
| | | 219 | | // /// Calculates the position on the route after the given distance from the starting point. |
| | | 220 | | // /// </summary> |
| | | 221 | | // public static Coordinate? PositionAfter(this Route route, float distanceInMeter) |
| | | 222 | | // { |
| | | 223 | | // var distanceMeter = 0.0; |
| | | 224 | | // if (route.Shape == null) |
| | | 225 | | // { |
| | | 226 | | // return null; |
| | | 227 | | // } |
| | | 228 | | // |
| | | 229 | | // for (var i = 0; i < route.Shape.Count - 1; i++) |
| | | 230 | | // { |
| | | 231 | | // var currentDistance = Coordinate.DistanceEstimateInMeter(route.Shape[i], route.Shape[i + 1]); |
| | | 232 | | // if (distanceMeter + currentDistance >= distanceInMeter) |
| | | 233 | | // { |
| | | 234 | | // var segmentDistance = distanceInMeter - distanceMeter; |
| | | 235 | | // var diffLat = route.Shape[i + 1].Latitude - route.Shape[i].Latitude; |
| | | 236 | | // var diffLon = route.Shape[i + 1].Longitude - route.Shape[i].Longitude; |
| | | 237 | | // var lat = route.Shape[i].Latitude + diffLat * (segmentDistance / currentDistance); |
| | | 238 | | // var lon = route.Shape[i].Longitude + diffLon * (segmentDistance / currentDistance); |
| | | 239 | | // if (!route.Shape[i].Elevation.HasValue || !route.Shape[i + 1].Elevation.HasValue) |
| | | 240 | | // return new Coordinate(lat, lon); |
| | | 241 | | // var s = route.Shape[i + 1].Elevation; |
| | | 242 | | // if (s == null) return new Coordinate(lat, lon); |
| | | 243 | | // var diffElev = s.Value - route.Shape[i].Elevation.Value; |
| | | 244 | | // short? elevation = (short) (route.Shape[i].Elevation.Value + diffElev * (segmentDistance / cur |
| | | 245 | | // return new Coordinate(lat, lon, elevation.Value); |
| | | 246 | | // } |
| | | 247 | | // distanceMeter += currentDistance; |
| | | 248 | | // } |
| | | 249 | | // return null; |
| | | 250 | | // } |
| | | 251 | | |
| | | 252 | | /// <summary> |
| | | 253 | | /// Distance and time a the given shape index. |
| | | 254 | | /// </summary> |
| | | 255 | | public static void DistanceAndTimeAt(this Route route, int shape, out double distance, out double time) |
| | 0 | 256 | | { |
| | 0 | 257 | | route.SegmentFor(shape, out var segmentStart, out var segmentEnd); |
| | | 258 | | |
| | 0 | 259 | | if (shape == segmentStart) |
| | 0 | 260 | | { |
| | 0 | 261 | | if (shape == 0) |
| | 0 | 262 | | { |
| | 0 | 263 | | distance = 0; |
| | 0 | 264 | | time = 0; |
| | 0 | 265 | | return; |
| | | 266 | | } |
| | | 267 | | else |
| | 0 | 268 | | { |
| | 0 | 269 | | var shapeMeta = route.ShapeMetaFor(shape); |
| | 0 | 270 | | distance = shapeMeta.Distance; |
| | 0 | 271 | | time = shapeMeta.Time; |
| | 0 | 272 | | return; |
| | | 273 | | } |
| | | 274 | | } |
| | | 275 | | |
| | 0 | 276 | | if (shape == segmentEnd) |
| | 0 | 277 | | { |
| | 0 | 278 | | if (shape == route.Shape.Count - 1) |
| | 0 | 279 | | { |
| | 0 | 280 | | distance = route.TotalDistance; |
| | 0 | 281 | | time = route.TotalTime; |
| | 0 | 282 | | return; |
| | | 283 | | } |
| | | 284 | | else |
| | 0 | 285 | | { |
| | 0 | 286 | | var shapeMeta = route.ShapeMetaFor(shape); |
| | 0 | 287 | | distance = shapeMeta.Distance; |
| | 0 | 288 | | time = shapeMeta.Time; |
| | 0 | 289 | | return; |
| | | 290 | | } |
| | | 291 | | } |
| | | 292 | | |
| | 0 | 293 | | var startDistance = 0.0; |
| | 0 | 294 | | var startTime = 0.0; |
| | 0 | 295 | | if (segmentStart == 0) |
| | 0 | 296 | | { |
| | 0 | 297 | | startDistance = 0; |
| | 0 | 298 | | startTime = 0; |
| | 0 | 299 | | } |
| | | 300 | | else |
| | 0 | 301 | | { |
| | 0 | 302 | | var shapeMeta = route.ShapeMetaFor(segmentStart); |
| | 0 | 303 | | startDistance = shapeMeta.Distance; |
| | 0 | 304 | | startTime = shapeMeta.Time; |
| | 0 | 305 | | } |
| | | 306 | | |
| | 0 | 307 | | var endDistance = 0.0; |
| | 0 | 308 | | var endTime = 0.0; |
| | 0 | 309 | | if (segmentEnd == route.Shape.Count - 1) |
| | 0 | 310 | | { |
| | 0 | 311 | | endDistance = route.TotalDistance; |
| | 0 | 312 | | endTime = route.TotalTime; |
| | 0 | 313 | | } |
| | | 314 | | else |
| | 0 | 315 | | { |
| | 0 | 316 | | var shapeMeta = route.ShapeMetaFor(segmentEnd); |
| | 0 | 317 | | endDistance = shapeMeta.Distance; |
| | 0 | 318 | | endTime = shapeMeta.Time; |
| | 0 | 319 | | } |
| | | 320 | | |
| | 0 | 321 | | var distanceToShape = 0.0; |
| | 0 | 322 | | var distanceOfSegment = 0.0; |
| | 0 | 323 | | for (var i = segmentStart; i < segmentEnd; i++) |
| | 0 | 324 | | { |
| | 0 | 325 | | if (i == shape) |
| | 0 | 326 | | { |
| | 0 | 327 | | distanceToShape = distanceOfSegment; |
| | 0 | 328 | | } |
| | | 329 | | |
| | 0 | 330 | | distanceOfSegment += route.Shape[i].DistanceEstimateInMeter(route.Shape[i + 1]); |
| | 0 | 331 | | } |
| | | 332 | | |
| | 0 | 333 | | var ratio = distanceToShape / distanceOfSegment; |
| | 0 | 334 | | distance = ((endDistance - startDistance) * ratio) + startDistance; |
| | 0 | 335 | | time = ((endTime - startTime) * ratio) + startTime; |
| | 0 | 336 | | } |
| | | 337 | | |
| | | 338 | | /// <summary> |
| | | 339 | | /// Gets the shape meta for the given shape index. |
| | | 340 | | /// </summary> |
| | | 341 | | public static Route.Meta? ShapeMetaFor(this Route route, int shape) |
| | 0 | 342 | | { |
| | 0 | 343 | | foreach (var shapeMeta in route.ShapeMeta) |
| | 0 | 344 | | { |
| | 0 | 345 | | if (shapeMeta.Shape == shape) |
| | 0 | 346 | | { |
| | 0 | 347 | | return shapeMeta; |
| | | 348 | | } |
| | 0 | 349 | | } |
| | | 350 | | |
| | 0 | 351 | | return null; |
| | 0 | 352 | | } |
| | | 353 | | |
| | | 354 | | /// <summary> |
| | | 355 | | /// Searches the segment the given shape index exists in. |
| | | 356 | | /// </summary> |
| | | 357 | | public static void SegmentFor(this Route route, int shape, out int segmentStart, out int segmentEnd) |
| | 0 | 358 | | { |
| | 0 | 359 | | segmentStart = 0; |
| | 0 | 360 | | segmentEnd = route.Shape.Count - 1; |
| | 0 | 361 | | if (route.ShapeMeta == null) |
| | 0 | 362 | | { |
| | 0 | 363 | | return; |
| | | 364 | | } |
| | | 365 | | |
| | 0 | 366 | | for (var i = 0; i < route.ShapeMeta.Count; i++) |
| | 0 | 367 | | { |
| | 0 | 368 | | if (route.ShapeMeta[i].Shape <= shape) |
| | 0 | 369 | | { |
| | 0 | 370 | | if (segmentStart <= route.ShapeMeta[i].Shape && |
| | 0 | 371 | | route.ShapeMeta[i].Shape < route.Shape.Count - 1) |
| | 0 | 372 | | { |
| | 0 | 373 | | segmentStart = route.ShapeMeta[i].Shape; |
| | 0 | 374 | | } |
| | 0 | 375 | | } |
| | 0 | 376 | | else if (route.ShapeMeta[i].Shape > shape) |
| | 0 | 377 | | { |
| | 0 | 378 | | segmentEnd = route.ShapeMeta[i].Shape; |
| | 0 | 379 | | break; |
| | | 380 | | } |
| | 0 | 381 | | } |
| | 0 | 382 | | } |
| | | 383 | | |
| | | 384 | | // /// <summary> |
| | | 385 | | // /// Calculates the closest point on the route relative to the given coordinate. |
| | | 386 | | // /// </summary> |
| | | 387 | | // /// <param name="route">The route.</param> |
| | | 388 | | // /// <param name="startShape">The shape to start at, relevant for routes with u-turns and navigation.</para |
| | | 389 | | // /// <param name="coordinate">The coordinate to project.</param> |
| | | 390 | | // /// <param name="projected">The projected coordinate on the route.</param> |
| | | 391 | | // /// <param name="distanceFromStartInMeter">The distance in meter to the projected point from the start of |
| | | 392 | | // /// <param name="timeFromStartInSeconds">The time in seconds to the projected point from the start of the |
| | | 393 | | // /// <param name="shape">The shape segment of the route the point was projected on to.</param> |
| | | 394 | | // /// <returns></returns> |
| | | 395 | | // public static bool ProjectOn(this Route route, int startShape, (double longitude, double latitude, float? |
| | | 396 | | // out double distanceFromStartInMeter, out double timeFromStartInSeconds) |
| | | 397 | | // { |
| | | 398 | | // var distance = double.MaxValue; |
| | | 399 | | // distanceFromStartInMeter = 0; |
| | | 400 | | // timeFromStartInSeconds = 0; |
| | | 401 | | // projected = new Coordinate(); |
| | | 402 | | // shape = -1; |
| | | 403 | | // |
| | | 404 | | // if (route.Shape == null) |
| | | 405 | | // { |
| | | 406 | | // return false; |
| | | 407 | | // } |
| | | 408 | | // |
| | | 409 | | // Coordinate currentProjected; |
| | | 410 | | // var currentDistanceFromStart = 0.0; |
| | | 411 | | // var currentDistance = 0.0; |
| | | 412 | | // for (var i = startShape; i < route.Shape.Count - 1; i++) |
| | | 413 | | // { |
| | | 414 | | // // project on shape and save distance and such. |
| | | 415 | | // var line = new Line(route.Shape[i], route.Shape[i + 1]); |
| | | 416 | | // var projectedPoint = line.ProjectOn(coordinate); |
| | | 417 | | // if (projectedPoint != null) |
| | | 418 | | // { // there was a projected point. |
| | | 419 | | // currentProjected = new Coordinate(projectedPoint.Value.Latitude, projectedPoint.Value.Longitud |
| | | 420 | | // currentDistance = Coordinate.DistanceEstimateInMeter(coordinate, currentProjected); |
| | | 421 | | // if (currentDistance < distance) |
| | | 422 | | // { // this point is closer. |
| | | 423 | | // projected = currentProjected; |
| | | 424 | | // shape = i; |
| | | 425 | | // distance = currentDistance; |
| | | 426 | | // |
| | | 427 | | // // calculate distance. |
| | | 428 | | // var localDistance = Coordinate.DistanceEstimateInMeter(currentProjected, route.Shape[i]); |
| | | 429 | | // distanceFromStartInMeter = currentDistanceFromStart + localDistance; |
| | | 430 | | // } |
| | | 431 | | // } |
| | | 432 | | // |
| | | 433 | | // // check first point. |
| | | 434 | | // currentProjected = route.Shape[i]; |
| | | 435 | | // currentDistance = Coordinate.DistanceEstimateInMeter(coordinate, currentProjected); |
| | | 436 | | // if (currentDistance < distance) |
| | | 437 | | // { // this point is closer. |
| | | 438 | | // projected = currentProjected; |
| | | 439 | | // shape = i; |
| | | 440 | | // distance = currentDistance; |
| | | 441 | | // distanceFromStartInMeter = currentDistanceFromStart; |
| | | 442 | | // } |
| | | 443 | | // |
| | | 444 | | // // update distance from start. |
| | | 445 | | // currentDistanceFromStart = currentDistanceFromStart + Coordinate.DistanceEstimateInMeter(route.Sha |
| | | 446 | | // } |
| | | 447 | | // |
| | | 448 | | // // check last point. |
| | | 449 | | // currentProjected = route.Shape[route.Shape.Count - 1]; |
| | | 450 | | // currentDistance = Coordinate.DistanceEstimateInMeter(coordinate, currentProjected); |
| | | 451 | | // if (currentDistance < distance) |
| | | 452 | | // { // this point is closer. |
| | | 453 | | // projected = currentProjected; |
| | | 454 | | // shape = route.Shape.Count - 1; |
| | | 455 | | // distance = currentDistance; |
| | | 456 | | // distanceFromStartInMeter = currentDistanceFromStart; |
| | | 457 | | // } |
| | | 458 | | // |
| | | 459 | | // // calculate time. |
| | | 460 | | // if (route.ShapeMeta == null) return true; |
| | | 461 | | // for (var metaIdx = 0; metaIdx < route.ShapeMeta.Count; metaIdx++) |
| | | 462 | | // { |
| | | 463 | | // var meta = route.ShapeMeta[metaIdx]; |
| | | 464 | | // if (meta == null || meta.Shape < shape + 1) continue; |
| | | 465 | | // var segmentStartTime = 0.0; |
| | | 466 | | // if (metaIdx > 0 && route.ShapeMeta[metaIdx - 1] != null) |
| | | 467 | | // { |
| | | 468 | | // segmentStartTime = route.ShapeMeta[metaIdx - 1].Time; |
| | | 469 | | // } |
| | | 470 | | // |
| | | 471 | | // var segmentDistance = 0.0; |
| | | 472 | | // var segmentDistanceOffset = 0.0; |
| | | 473 | | // for (var s = startShape; s < meta.Shape; s++) |
| | | 474 | | // { |
| | | 475 | | // var d = Coordinate.DistanceEstimateInMeter( |
| | | 476 | | // route.Shape[s], route.Shape[s + 1]); |
| | | 477 | | // if (s < shape) |
| | | 478 | | // { |
| | | 479 | | // segmentDistanceOffset += d; |
| | | 480 | | // } |
| | | 481 | | // else if (s == shape) |
| | | 482 | | // { |
| | | 483 | | // segmentDistanceOffset += Coordinate.DistanceEstimateInMeter( |
| | | 484 | | // route.Shape[s], projected); |
| | | 485 | | // } |
| | | 486 | | // segmentDistance += d; |
| | | 487 | | // } |
| | | 488 | | // |
| | | 489 | | // if (Math.Abs(segmentDistance) < double.Epsilon) |
| | | 490 | | // { |
| | | 491 | | // break; |
| | | 492 | | // } |
| | | 493 | | // timeFromStartInSeconds = segmentStartTime + (meta.Time - |
| | | 494 | | // segmentStartTime) * (segmentDistanceOffset / segmentD |
| | | 495 | | // break; |
| | | 496 | | // } |
| | | 497 | | // return true; |
| | | 498 | | // } |
| | | 499 | | // |
| | | 500 | | // /// <summary> |
| | | 501 | | // /// Returns the turn direction for the shape point at the given index. |
| | | 502 | | // /// </summary> |
| | | 503 | | // public static RelativeDirection RelativeDirectionAt(this Route route, int i, float toleranceInMeters = 1) |
| | | 504 | | // { |
| | | 505 | | // if (i < 0 || i >= route.Shape.Count) { throw new ArgumentOutOfRangeException(nameof(i)); } |
| | | 506 | | // |
| | | 507 | | // if (i == 0 || i == route.Shape.Count - 1) |
| | | 508 | | // { // not possible to calculate a relative direction for the first or last segment. |
| | | 509 | | // throw new ArgumentOutOfRangeException(nameof(i), "It's not possible to calculate a relative direct |
| | | 510 | | // } |
| | | 511 | | // |
| | | 512 | | // var h = i - 1; |
| | | 513 | | // while (h > 0 && Coordinate.DistanceEstimateInMeter(route.Shape[h].Latitude, route.Shape[h].Longitude, |
| | | 514 | | // route.Shape[i].Latitude, route.Shape[i].Longitude) < toleranceInMeters) |
| | | 515 | | // { // work backward from i to make sure we don't use an identical coordinate or one that's too close to |
| | | 516 | | // h--; |
| | | 517 | | // } |
| | | 518 | | // var j = i + 1; |
| | | 519 | | // while (j < route.Shape.Count - 1 && Coordinate.DistanceEstimateInMeter(route.Shape[j].Latitude, route. |
| | | 520 | | // route.Shape[i].Latitude, route.Shape[i].Longitude) < toleranceInMeters) |
| | | 521 | | // { // work forward from i to make sure we don't use an identical coordinate or one that's too close to |
| | | 522 | | // j++; |
| | | 523 | | // } |
| | | 524 | | // |
| | | 525 | | // var dir = DirectionCalculator.Calculate( |
| | | 526 | | // new Coordinate(route.Shape[h].Latitude, route.Shape[h].Longitude), |
| | | 527 | | // new Coordinate(route.Shape[i].Latitude, route.Shape[i].Longitude), |
| | | 528 | | // new Coordinate(route.Shape[j].Latitude, route.Shape[j].Longitude)); |
| | | 529 | | // if (double.IsNaN(dir.Angle)) |
| | | 530 | | // { // it's possible the angle doesn't make sense, best to not return anything in that case. |
| | | 531 | | // return null; |
| | | 532 | | // } |
| | | 533 | | // return dir; |
| | | 534 | | // } |
| | | 535 | | // |
| | | 536 | | // /// <summary> |
| | | 537 | | // /// Returns the direction to the next shape segment. |
| | | 538 | | // /// </summary> |
| | | 539 | | // public static DirectionEnum DirectionToNext(this Route route, int i) |
| | | 540 | | // { |
| | | 541 | | // if (i < 0 || i >= route.Shape.Count - 1) { throw new ArgumentOutOfRangeException(nameof(i)); } |
| | | 542 | | // |
| | | 543 | | // return DirectionCalculator.Calculate( |
| | | 544 | | // new Coordinate(route.Shape[i].Latitude, route.Shape[i].Longitude), |
| | | 545 | | // new Coordinate(route.Shape[i + 1].Latitude, route.Shape[i + 1].Longitude)); |
| | | 546 | | // } |
| | | 547 | | |
| | | 548 | | /// <summary> |
| | | 549 | | /// Calculates the distance between two shape points along the route. |
| | | 550 | | /// </summary> |
| | | 551 | | /// <param name="route">The route.</param> |
| | | 552 | | /// <param name="shapeStart">The first shape point index.</param> |
| | | 553 | | /// <param name="shapeEnd">The second shape point index.</param> |
| | | 554 | | /// <returns></returns> |
| | | 555 | | public static double DistanceBetween(this Route route, int shapeStart, int shapeEnd) |
| | 6 | 556 | | { |
| | 6 | 557 | | var sum = 0.0; |
| | 38 | 558 | | for (var i = shapeStart; i < shapeEnd; i++) |
| | 13 | 559 | | { |
| | 13 | 560 | | sum += route.Shape[i].DistanceEstimateInMeterShape(route.Shape[i + 1]); |
| | 13 | 561 | | } |
| | 6 | 562 | | return sum; |
| | 6 | 563 | | } |
| | | 564 | | |
| | | 565 | | /// <summary> |
| | | 566 | | /// Calculates the absolute bearing if travelling from the given shape index towards the next shapeIndex. |
| | | 567 | | /// </summary> |
| | | 568 | | /// <remarks>0° is north, 90° is east, -90° is west, both 180 and -180 are south. Gives null for the last point</rem |
| | | 569 | | /// <param name="route">The route.</param> |
| | | 570 | | /// <param name="shape">The shape point index.</param> |
| | | 571 | | /// <returns></returns> |
| | | 572 | | public static double? BearingAt(this Route route, int shape) |
| | 1 | 573 | | { |
| | 1 | 574 | | if (route.Shape.Count < shape + 2) |
| | 0 | 575 | | { // Plus two, as we'll increase shape later on |
| | 0 | 576 | | return null; |
| | | 577 | | } |
| | | 578 | | |
| | 1 | 579 | | var current = route.Shape[shape]; |
| | 1 | 580 | | var next = route.Shape[shape + 1]; |
| | | 581 | | |
| | 1 | 582 | | return current.AngleWithMeridian(next); |
| | 1 | 583 | | } |
| | | 584 | | } |