| | | 1 | | using System; |
| | | 2 | | using System.Linq; |
| | | 3 | | using System.Threading; |
| | | 4 | | using System.Threading.Tasks; |
| | | 5 | | using Itinero.Geo; |
| | | 6 | | using Itinero.Network; |
| | | 7 | | using Itinero.Routes; |
| | | 8 | | using Itinero.Routes.Paths; |
| | | 9 | | using Itinero.Routing.Flavours.Dijkstra; |
| | | 10 | | using Itinero.Routing.Flavours.Dijkstra.Bidirectional; |
| | | 11 | | using Itinero.Snapping; |
| | | 12 | | |
| | | 13 | | namespace Itinero.Routing; |
| | | 14 | | |
| | | 15 | | /// <summary> |
| | | 16 | | /// One to one extensions. |
| | | 17 | | /// </summary> |
| | | 18 | | public static class IRouterOneToOneExtensions |
| | | 19 | | { |
| | | 20 | | /// <summary> |
| | | 21 | | /// Calculates the path. |
| | | 22 | | /// </summary> |
| | | 23 | | /// <param name="oneToOneRouter">The router.</param> |
| | | 24 | | /// <param name="cancellationToken"></param> |
| | | 25 | | /// <returns>The path.</returns> |
| | | 26 | | public static async Task<Result<Path>> PathAsync(this IRouterOneToOne oneToOneRouter, |
| | | 27 | | CancellationToken cancellationToken = default) |
| | 69 | 28 | | { |
| | 69 | 29 | | if (oneToOneRouter.Source.direction == null && oneToOneRouter.Target.direction == null && |
| | 69 | 30 | | !oneToOneRouter.Settings.Profile.TurnCostFactorEnabled) |
| | 64 | 31 | | { |
| | 64 | 32 | | return await oneToOneRouter.CalculateAsync(oneToOneRouter.Source.sp, oneToOneRouter.Target.sp, |
| | 64 | 33 | | cancellationToken); |
| | | 34 | | } |
| | | 35 | | |
| | 5 | 36 | | return (await oneToOneRouter.CalculateAsync([oneToOneRouter.Source], [oneToOneRouter.Target]))[0][0]; |
| | 69 | 37 | | } |
| | | 38 | | |
| | | 39 | | /// <summary> |
| | | 40 | | /// Calculates the route. |
| | | 41 | | /// </summary> |
| | | 42 | | /// <param name="oneToOneRouter">The router.</param> |
| | | 43 | | /// <param name="cancellationToken"></param> |
| | | 44 | | /// <returns>The route.</returns> |
| | | 45 | | public static async Task<Result<Route>> CalculateAsync(this IRouterOneToOne oneToOneRouter, |
| | | 46 | | CancellationToken cancellationToken = default) |
| | 31 | 47 | | { |
| | 31 | 48 | | var path = await oneToOneRouter.PathAsync(cancellationToken); |
| | 31 | 49 | | if (path.IsError) |
| | 15 | 50 | | { |
| | 15 | 51 | | return new Result<Route>(path.ErrorMessage); |
| | | 52 | | } |
| | | 53 | | |
| | 16 | 54 | | return oneToOneRouter.Settings.RouteBuilder.Build(oneToOneRouter.Network, oneToOneRouter.Settings.Profile, |
| | 16 | 55 | | path.Value); |
| | 31 | 56 | | } |
| | | 57 | | |
| | | 58 | | /// <summary> |
| | | 59 | | /// Calculates the weights. |
| | | 60 | | /// </summary> |
| | | 61 | | /// <param name="oneToOneWeightRouter">The router.</param> |
| | | 62 | | /// <returns>The weight</returns> |
| | | 63 | | public static Task<Result<double?>> CalculateAsync(this IRouterWeights<IRouterOneToOne> oneToOneWeightRouter) |
| | 0 | 64 | | { |
| | 0 | 65 | | return Task.FromResult(new Result<double?>("Not implemented")); |
| | | 66 | | |
| | | 67 | | // var profileHandler = oneToOneWeightRouter.Router.Network.GetCostFunctionFor( |
| | | 68 | | // oneToOneWeightRouter.Router.Settings.Profile); |
| | | 69 | | // return oneToOneWeightRouter.Router.Path().Weight(profileHandler.GetForwardWeight); |
| | 0 | 70 | | } |
| | | 71 | | |
| | | 72 | | internal static async Task<Result<Path>> CalculateAsync(this IRouterOneToOne oneToOneRouter, |
| | | 73 | | SnapPoint source, SnapPoint target, CancellationToken cancellationToken) |
| | 64 | 74 | | { |
| | 64 | 75 | | var settings = oneToOneRouter.Settings; |
| | 64 | 76 | | var routingNetwork = oneToOneRouter.Network; |
| | | 77 | | |
| | 64 | 78 | | var profile = settings.Profile; |
| | 64 | 79 | | var costFunction = routingNetwork.GetCostFunctionFor(profile); |
| | 64 | 80 | | if (settings.CostFunctionWrapper != null) costFunction = settings.CostFunctionWrapper(costFunction); |
| | | 81 | | |
| | 64 | 82 | | var maxBox = settings.MaxBoxFor(routingNetwork, [source, target]); |
| | | 83 | | |
| | 64 | 84 | | var isMainN = routingNetwork.GetIsMainNFunc(profile); |
| | 64 | 85 | | var (result, _) = await BidirectionalDijkstra.Default.RunAsync(routingNetwork, source, target, costFunction, |
| | 64 | 86 | | async v => |
| | 1517 | 87 | | { |
| | 1517 | 88 | | if (!routingNetwork.UsageNotifier.IsVertexDataReady(routingNetwork, v)) |
| | 0 | 89 | | { |
| | 0 | 90 | | await routingNetwork.UsageNotifier.NotifyVertex(routingNetwork, v, cancellationToken); |
| | 0 | 91 | | } |
| | 1517 | 92 | | if (cancellationToken.IsCancellationRequested) return false; |
| | 1517 | 93 | | return CheckMaxDistance(v); |
| | 1581 | 94 | | }, cancellationToken: cancellationToken, isMainN: isMainN); |
| | | 95 | | |
| | 74 | 96 | | if (result == null) return new Result<Path>("Path not found"); |
| | | 97 | | |
| | 54 | 98 | | return result; |
| | | 99 | | |
| | | 100 | | bool CheckMaxDistance(VertexId v) |
| | 1517 | 101 | | { |
| | 1517 | 102 | | if (routingNetwork == null) throw new Exception("Router cannot be null here."); |
| | 3034 | 103 | | if (maxBox == null) return false; |
| | | 104 | | |
| | 0 | 105 | | var vertex = routingNetwork.GetVertex(v); |
| | 0 | 106 | | if (!maxBox.Value.Overlaps(vertex)) |
| | 0 | 107 | | { |
| | 0 | 108 | | return true; |
| | | 109 | | } |
| | | 110 | | |
| | 0 | 111 | | return false; |
| | 1517 | 112 | | } |
| | 64 | 113 | | } |
| | | 114 | | } |