| | | 1 | | using System; |
| | | 2 | | using System.Collections.Generic; |
| | | 3 | | using System.Linq; |
| | | 4 | | using Itinero.Network; |
| | | 5 | | using Itinero.Network.Enumerators.Edges; |
| | | 6 | | using Itinero.Profiles; |
| | | 7 | | using Itinero.Routing.Costs.Caches; |
| | | 8 | | |
| | | 9 | | using Itinero.Routing.Flavours.Dijkstra; |
| | | 10 | | |
| | | 11 | | namespace Itinero.Routing.Costs; |
| | | 12 | | |
| | | 13 | | internal class ProfileCostFunctionCached : ICostFunction |
| | | 14 | | { |
| | | 15 | | private readonly Profile _profile; |
| | | 16 | | private readonly EdgeFactorCache _edgeFactorCache; |
| | | 17 | | private readonly TurnCostFactorCache _turnCostFactorCache; |
| | | 18 | | |
| | 13712 | 19 | | internal ProfileCostFunctionCached(Profile profile, EdgeFactorCache edgeFactorCache, TurnCostFactorCache turnCostFac |
| | 13712 | 20 | | { |
| | 13712 | 21 | | _profile = profile; |
| | 13712 | 22 | | _edgeFactorCache = edgeFactorCache; |
| | 13712 | 23 | | _turnCostFactorCache = turnCostFactorCache; |
| | 13712 | 24 | | } |
| | | 25 | | |
| | | 26 | | public (bool canAccess, bool canStop, bool localAccess, double cost, double turnCost) Get( |
| | | 27 | | IEdgeEnumerator<RoutingNetwork> edgeEnumerator, bool tailToHead = true, |
| | | 28 | | PreviousEdgeEnumerable previousEdges = default) |
| | 1096023 | 29 | | { |
| | | 30 | | |
| | | 31 | | // get edge factor and length. |
| | | 32 | | EdgeFactor factor; |
| | 1096023 | 33 | | var edgeTypeId = edgeEnumerator.EdgeTypeId; |
| | 1096023 | 34 | | if (edgeTypeId == null) |
| | 28 | 35 | | { |
| | 28 | 36 | | factor = _profile.FactorInEdgeDirection(edgeEnumerator); |
| | 28 | 37 | | } |
| | | 38 | | else |
| | 1095995 | 39 | | { |
| | 1095995 | 40 | | var edgeFactor = _edgeFactorCache.Get(edgeTypeId.Value); |
| | 1095995 | 41 | | if (edgeFactor == null) |
| | 1802 | 42 | | { |
| | | 43 | | // no cached value, cache forward value. |
| | 1802 | 44 | | factor = _profile.Factor(edgeEnumerator.Attributes); |
| | 1802 | 45 | | _edgeFactorCache.Set(edgeTypeId.Value, factor); |
| | 1802 | 46 | | } |
| | | 47 | | else |
| | 1094193 | 48 | | { |
| | 1094193 | 49 | | factor = edgeFactor.Value; |
| | 1094193 | 50 | | } |
| | | 51 | | |
| | | 52 | | // cached value is always forward. |
| | 1095995 | 53 | | if (!edgeEnumerator.Forward) |
| | 495510 | 54 | | { |
| | 495510 | 55 | | factor = factor.Reverse; |
| | 495510 | 56 | | } |
| | 1095995 | 57 | | } |
| | | 58 | | |
| | 1096023 | 59 | | var lengthNullable = edgeEnumerator.Length; |
| | 1096023 | 60 | | var length = lengthNullable ?? |
| | 1096023 | 61 | | (uint)(edgeEnumerator.EdgeLength() * 100); |
| | 1096023 | 62 | | var cost = tailToHead ? factor.ForwardFactor * length : factor.BackwardFactor * length; |
| | 1096023 | 63 | | var canAccess = tailToHead ? factor.ForwardFactor > 0 : factor.BackwardFactor > 0; |
| | 1096023 | 64 | | var localAccess = factor.IsLocalAccess; |
| | | 65 | | |
| | 1096023 | 66 | | var totalTurnCost = 0.0; |
| | 1096023 | 67 | | var turn = previousEdges.First?.turn; |
| | 2172864 | 68 | | if (turn == null) return (canAccess, factor.CanStop, localAccess, cost, totalTurnCost); |
| | | 69 | | |
| | 19182 | 70 | | if (tailToHead) |
| | 19169 | 71 | | { |
| | 19169 | 72 | | var turnCosts = edgeEnumerator.GetTurnCostToTail(turn.Value); |
| | | 73 | | |
| | 95800 | 74 | | foreach (var (turnCostType, attributes, turnCost, prefixEdges) in turnCosts) |
| | 19161 | 75 | | { |
| | | 76 | | // TODO: compare prefix edges with the previous edges. |
| | | 77 | | |
| | 19161 | 78 | | var turnCostFactor = _turnCostFactorCache.Get(turnCostType); |
| | 19161 | 79 | | if (turnCostFactor == null) |
| | 55 | 80 | | { |
| | 55 | 81 | | turnCostFactor = _profile.TurnCostFactor(attributes); |
| | 55 | 82 | | _turnCostFactorCache.Set(turnCostType, turnCostFactor.Value); |
| | 55 | 83 | | } |
| | | 84 | | |
| | 19161 | 85 | | if (turnCostFactor.Value.IsBinary && turnCost > 0) |
| | 29 | 86 | | { |
| | 29 | 87 | | totalTurnCost = double.MaxValue; |
| | 29 | 88 | | break; |
| | | 89 | | } |
| | | 90 | | |
| | 19132 | 91 | | totalTurnCost += turnCostFactor.Value.CostFactor * turnCost; |
| | 19132 | 92 | | } |
| | 19169 | 93 | | } |
| | | 94 | | else |
| | 13 | 95 | | { |
| | 13 | 96 | | var turnCosts = edgeEnumerator.GetTurnCostFromTail(turn.Value); |
| | | 97 | | |
| | 49 | 98 | | foreach (var (turnCostType, attributes, turnCost, prefixEdges) in turnCosts) |
| | 9 | 99 | | { |
| | | 100 | | // TODO: compare prefix edges with the previous edges. |
| | | 101 | | |
| | 9 | 102 | | var turnCostFactor = _turnCostFactorCache.Get(turnCostType); |
| | 9 | 103 | | if (turnCostFactor == null) |
| | 1 | 104 | | { |
| | 1 | 105 | | turnCostFactor = _profile.TurnCostFactor(attributes); |
| | 1 | 106 | | _turnCostFactorCache.Set(turnCostType, turnCostFactor.Value); |
| | 1 | 107 | | } |
| | | 108 | | |
| | 9 | 109 | | if (turnCostFactor.Value.IsBinary && turnCost > 0) |
| | 8 | 110 | | { |
| | 8 | 111 | | totalTurnCost = double.MaxValue; |
| | 8 | 112 | | break; |
| | | 113 | | } |
| | | 114 | | |
| | 1 | 115 | | totalTurnCost += turnCostFactor.Value.CostFactor * turnCost; |
| | 1 | 116 | | } |
| | 13 | 117 | | } |
| | | 118 | | |
| | 19182 | 119 | | return (canAccess, factor.CanStop, localAccess, cost, totalTurnCost); |
| | 1096023 | 120 | | } |
| | | 121 | | } |