Open-Harbor/osrm-backend
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases 3 Wiki Activity

wip

Browse Source
This commit is contained in:
Siarhei Fedartsou
2024-05-26 12:19:58 +02:00
parent 49cf294d2f
commit 8b34d5b40c
4 changed files with 205 additions and 24 deletions
Download Patch File Download Diff File Expand all files Collapse all files
include/engine/routing_algorithms/routing_base_ch.hpp
+17
View File
@@ -471,6 +471,23 @@ double getNetworkDistance(SearchEngineData<Algorithm> &engine_working_data,
const PhantomNode &target_phantom,
EdgeWeight duration_upper_bound = INVALID_EDGE_WEIGHT);
inline double getNetworkDistanceOld(SearchEngineData<Algorithm> &engine_working_data,
const DataFacade<ch::Algorithm> &facade,
SearchEngineData<Algorithm>::QueryHeap &forward_heap,
SearchEngineData<Algorithm>::QueryHeap &reverse_heap,
const PhantomNode &source_phantom,
const PhantomNode &target_phantom,
EdgeWeight duration_upper_bound = INVALID_EDGE_WEIGHT)
{
return getNetworkDistance(engine_working_data,
facade,
forward_heap,
reverse_heap,
source_phantom,
target_phantom,
duration_upper_bound);
}
template <typename EdgeMetric>
std::tuple<EdgeMetric, EdgeDistance> getLoopMetric(const DataFacade<Algorithm> &facade, NodeID node)
{
include/engine/routing_algorithms/routing_base_mld.hpp
+115 -23
View File
@@ -705,42 +705,134 @@ double getNetworkDistance(SearchEngineData<Algorithm> &engine_working_data,
EdgeWeight weight_upper_bound = INVALID_EDGE_WEIGHT)
{
reverse_heap.Clear();
// forward_heap.Clear();
if (forward_heap.empty()) {
if (source_phantom.IsValidForwardSource())
{
forward_heap.Insert(source_phantom.forward_segment_id.id,
EdgeWeight{0} - source_phantom.GetForwardWeightPlusOffset(),
{source_phantom.forward_segment_id.id,
false,
EdgeDistance{0} - source_phantom.GetForwardDistance()});
}
// if (forward_heap.Empty())
// {
// if (source_phantom.IsValidForwardSource())
// {
// forward_heap.Insert(source_phantom.forward_segment_id.id,
// EdgeWeight{0} - source_phantom.GetForwardWeightPlusOffset(),
// {source_phantom.forward_segment_id.id,
// false,
// EdgeDistance{0} - source_phantom.GetForwardDistance()});
// }
if (source_phantom.IsValidReverseSource())
// if (source_phantom.IsValidReverseSource())
// {
// forward_heap.Insert(source_phantom.reverse_segment_id.id,
// EdgeWeight{0} - source_phantom.GetReverseWeightPlusOffset(),
// {source_phantom.reverse_segment_id.id,
// false,
// EdgeDistance{0} - source_phantom.GetReverseDistance()});
// }
// } else {
// const auto node =
// forward_heap.GetHeapNodeIfWasInserted(target_phantom.forward_segment_id.id); if (node) {
// std::cerr << "Found " << target_phantom.forward_segment_id.id << " in forward_heap "
// << node->data.distance << std::endl;
// }
// }
if (!forward_heap.Empty())
{
if (target_phantom.IsValidForwardTarget() && !target_phantom.IsValidReverseTarget())
{
forward_heap.Insert(source_phantom.reverse_segment_id.id,
EdgeWeight{0} - source_phantom.GetReverseWeightPlusOffset(),
{source_phantom.reverse_segment_id.id,
false,
EdgeDistance{0} - source_phantom.GetReverseDistance()});
if (const auto node =
forward_heap.GetHeapNodeIfWasInserted(target_phantom.forward_segment_id.id))
{
return from_alias<double>(node->data.distance);
}
}
// if (target_phantom.IsValidReverseTarget()) {
// if (const auto node =
// forward_heap.GetHeapNodeIfWasInserted(target_phantom.reverse_segment_id.id)) {
// return from_alias<double>(node->data.distance);
// }
// }
}
forward_heap.Clear();
if (source_phantom.IsValidForwardSource())
{
forward_heap.Insert(source_phantom.forward_segment_id.id,
EdgeWeight{0},
{source_phantom.forward_segment_id.id, false, EdgeDistance{0}});
}
if (source_phantom.IsValidReverseSource())
{
forward_heap.Insert(source_phantom.reverse_segment_id.id,
EdgeWeight{0},
{source_phantom.reverse_segment_id.id, false, EdgeDistance{0}});
}
if (target_phantom.IsValidForwardTarget())
{
reverse_heap.Insert(
target_phantom.forward_segment_id.id,
target_phantom.GetForwardWeightPlusOffset(),
{target_phantom.forward_segment_id.id, false, target_phantom.GetForwardDistance()});
reverse_heap.Insert(target_phantom.forward_segment_id.id,
EdgeWeight{0},
{target_phantom.forward_segment_id.id, false, EdgeDistance{0}});
}
if (target_phantom.IsValidReverseTarget())
{
reverse_heap.Insert(
target_phantom.reverse_segment_id.id,
target_phantom.GetReverseWeightPlusOffset(),
{target_phantom.reverse_segment_id.id, false, target_phantom.GetReverseDistance()});
reverse_heap.Insert(target_phantom.reverse_segment_id.id,
EdgeWeight{0},
{target_phantom.reverse_segment_id.id, false, EdgeDistance{0}});
}
const PhantomEndpoints endpoints{source_phantom, target_phantom};
auto distance = searchDistance(
engine_working_data, facade, forward_heap, reverse_heap, {}, weight_upper_bound, endpoints);
if (distance == INVALID_EDGE_DISTANCE)
{
return std::numeric_limits<double>::max();
}
return from_alias<double>(distance);
}
template <typename Algorithm>
double
getNetworkDistanceOld(SearchEngineData<Algorithm> &engine_working_data,
const DataFacade<Algorithm> &facade,
typename SearchEngineData<Algorithm>::MapMatchingQueryHeap &forward_heap,
typename SearchEngineData<Algorithm>::MapMatchingQueryHeap &reverse_heap,
const PhantomNode &source_phantom,
const PhantomNode &target_phantom,
EdgeWeight weight_upper_bound = INVALID_EDGE_WEIGHT)
{
reverse_heap.Clear();
forward_heap.Clear();
if (source_phantom.IsValidForwardSource())
{
forward_heap.Insert(source_phantom.forward_segment_id.id,
EdgeWeight{0},
{source_phantom.forward_segment_id.id, false, EdgeDistance{0}});
}
if (source_phantom.IsValidReverseSource())
{
forward_heap.Insert(source_phantom.reverse_segment_id.id,
EdgeWeight{0},
{source_phantom.reverse_segment_id.id, false, EdgeDistance{0}});
}
if (target_phantom.IsValidForwardTarget())
{
reverse_heap.Insert(target_phantom.forward_segment_id.id,
EdgeWeight{0},
{target_phantom.forward_segment_id.id, false, EdgeDistance{0}});
}
if (target_phantom.IsValidReverseTarget())
{
reverse_heap.Insert(target_phantom.reverse_segment_id.id,
EdgeWeight{0},
{target_phantom.reverse_segment_id.id, false, EdgeDistance{0}});
}
const PhantomEndpoints endpoints{source_phantom, target_phantom};