Refactor processing_chain by splitting into sub functions
This commit is contained in:
+85
-255
@@ -52,269 +52,34 @@ SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
#include <unordered_map>
|
||||
#include <vector>
|
||||
|
||||
template <typename EdgeT>
|
||||
NodeID read_undirected_osrm_stream(std::istream &input_stream,
|
||||
std::vector<EdgeT> &edge_list,
|
||||
std::vector<FixedPointCoordinate> &coordinate_list)
|
||||
/**
|
||||
* Reads the .restrictions file and loads it to a vector.
|
||||
* The since the restrictions reference nodes using their external node id,
|
||||
* we need to renumber it to the new internal id.
|
||||
*/
|
||||
unsigned loadRestrictionsFromFile(std::istream& input_stream,
|
||||
const std::unordered_map<NodeID, NodeID>& ext_to_int_id_map,
|
||||
std::vector<TurnRestriction>& restriction_list)
|
||||
{
|
||||
const FingerPrint fingerprint_orig;
|
||||
FingerPrint fingerprint_loaded;
|
||||
input_stream.read(reinterpret_cast<char *>(&fingerprint_loaded), sizeof(FingerPrint));
|
||||
|
||||
if (!fingerprint_loaded.TestGraphUtil(fingerprint_orig))
|
||||
unsigned number_of_usable_restrictions = 0;
|
||||
input_stream.read((char *)&fingerprint_loaded, sizeof(FingerPrint));
|
||||
if (!fingerprint_loaded.TestPrepare(fingerprint_orig))
|
||||
{
|
||||
SimpleLogger().Write(logWARNING) << ".osrm was prepared with different build.\n"
|
||||
SimpleLogger().Write(logWARNING) << ".restrictions was prepared with different build.\n"
|
||||
"Reprocess to get rid of this warning.";
|
||||
}
|
||||
|
||||
std::unordered_map<NodeID, NodeID> ext_to_int_id_map;
|
||||
|
||||
NodeID n;
|
||||
input_stream.read(reinterpret_cast<char *>(&n), sizeof(NodeID));
|
||||
SimpleLogger().Write() << "Importing n = " << n << " nodes ";
|
||||
|
||||
ExternalMemoryNode current_node;
|
||||
for (NodeID i = 0; i < n; ++i)
|
||||
input_stream.read((char *)&number_of_usable_restrictions, sizeof(unsigned));
|
||||
restriction_list.resize(number_of_usable_restrictions);
|
||||
if (number_of_usable_restrictions > 0)
|
||||
{
|
||||
input_stream.read(reinterpret_cast<char *>(¤t_node), sizeof(ExternalMemoryNode));
|
||||
coordinate_list.emplace_back(current_node.lat, current_node.lon);
|
||||
ext_to_int_id_map.emplace(current_node.node_id, i);
|
||||
// if (current_node.barrier)
|
||||
// {
|
||||
// barrier_node_list.emplace_back(i);
|
||||
// }
|
||||
// if (current_node.traffic_lights)
|
||||
// {
|
||||
// traffic_light_node_list.emplace_back(i);
|
||||
// }
|
||||
input_stream.read((char *) restriction_list.data(),
|
||||
number_of_usable_restrictions * sizeof(TurnRestriction));
|
||||
}
|
||||
|
||||
// tighten vector sizes
|
||||
// barrier_node_list.shrink_to_fit();
|
||||
// traffic_light_node_list.shrink_to_fit();
|
||||
|
||||
// renumber nodes in turn restrictions
|
||||
// for (TurnRestriction ¤t_restriction : restriction_list)
|
||||
// {
|
||||
// auto internal_id_iter = ext_to_int_id_map.find(current_restriction.from.node);
|
||||
// if (internal_id_iter == ext_to_int_id_map.end())
|
||||
// {
|
||||
// SimpleLogger().Write(logDEBUG) << "Unmapped from node " <<
|
||||
// current_restriction.from.node
|
||||
// << " of restriction";
|
||||
// continue;
|
||||
// }
|
||||
// current_restriction.from.node = internal_id_iter->second;
|
||||
|
||||
// internal_id_iter = ext_to_int_id_map.find(current_restriction.via.node);
|
||||
// if (internal_id_iter == ext_to_int_id_map.end())
|
||||
// {
|
||||
// SimpleLogger().Write(logDEBUG) << "Unmapped via node " <<
|
||||
// current_restriction.via.node
|
||||
// << " of restriction";
|
||||
// continue;
|
||||
// }
|
||||
|
||||
// current_restriction.via.node = internal_id_iter->second;
|
||||
|
||||
// internal_id_iter = ext_to_int_id_map.find(current_restriction.to.node);
|
||||
// if (internal_id_iter == ext_to_int_id_map.end())
|
||||
// {
|
||||
// SimpleLogger().Write(logDEBUG) << "Unmapped to node " << current_restriction.to.node
|
||||
// << " of restriction";
|
||||
// continue;
|
||||
// }
|
||||
// current_restriction.to.node = internal_id_iter->second;
|
||||
// }
|
||||
|
||||
EdgeWeight weight;
|
||||
NodeID source, target;
|
||||
unsigned nameID;
|
||||
int length;
|
||||
short dir; // direction (0 = open, 1 = forward, 2+ = open)
|
||||
bool is_roundabout, ignore_in_grid, is_access_restricted, is_split;
|
||||
TravelMode travel_mode;
|
||||
|
||||
EdgeID m;
|
||||
input_stream.read(reinterpret_cast<char *>(&m), sizeof(unsigned));
|
||||
edge_list.reserve(m);
|
||||
SimpleLogger().Write() << " and " << m << " edges ";
|
||||
|
||||
for (EdgeID i = 0; i < m; ++i)
|
||||
{
|
||||
input_stream.read(reinterpret_cast<char *>(&source), sizeof(unsigned));
|
||||
input_stream.read(reinterpret_cast<char *>(&target), sizeof(unsigned));
|
||||
input_stream.read(reinterpret_cast<char *>(&length), sizeof(int));
|
||||
input_stream.read(reinterpret_cast<char *>(&dir), sizeof(short));
|
||||
input_stream.read(reinterpret_cast<char *>(&weight), sizeof(int));
|
||||
input_stream.read(reinterpret_cast<char *>(&nameID), sizeof(unsigned));
|
||||
input_stream.read(reinterpret_cast<char *>(&is_roundabout), sizeof(bool));
|
||||
input_stream.read(reinterpret_cast<char *>(&ignore_in_grid), sizeof(bool));
|
||||
input_stream.read(reinterpret_cast<char *>(&is_access_restricted), sizeof(bool));
|
||||
input_stream.read(reinterpret_cast<char *>(&travel_mode), sizeof(TravelMode));
|
||||
input_stream.read(reinterpret_cast<char *>(&is_split), sizeof(bool));
|
||||
|
||||
BOOST_ASSERT_MSG(length > 0, "loaded null length edge");
|
||||
BOOST_ASSERT_MSG(weight > 0, "loaded null weight");
|
||||
BOOST_ASSERT_MSG(0 <= dir && dir <= 2, "loaded bogus direction");
|
||||
|
||||
// bool forward = true;
|
||||
// bool backward = true;
|
||||
// if (1 == dir)
|
||||
// {
|
||||
// backward = false;
|
||||
// }
|
||||
// if (2 == dir)
|
||||
// {
|
||||
// forward = false;
|
||||
// }
|
||||
|
||||
// translate the external NodeIDs to internal IDs
|
||||
auto internal_id_iter = ext_to_int_id_map.find(source);
|
||||
if (ext_to_int_id_map.find(source) == ext_to_int_id_map.end())
|
||||
{
|
||||
#ifndef NDEBUG
|
||||
SimpleLogger().Write(logWARNING) << " unresolved source NodeID: " << source;
|
||||
#endif
|
||||
continue;
|
||||
}
|
||||
source = internal_id_iter->second;
|
||||
internal_id_iter = ext_to_int_id_map.find(target);
|
||||
if (ext_to_int_id_map.find(target) == ext_to_int_id_map.end())
|
||||
{
|
||||
#ifndef NDEBUG
|
||||
SimpleLogger().Write(logWARNING) << "unresolved target NodeID : " << target;
|
||||
#endif
|
||||
continue;
|
||||
}
|
||||
target = internal_id_iter->second;
|
||||
BOOST_ASSERT_MSG(source != SPECIAL_NODEID && target != SPECIAL_NODEID,
|
||||
"nonexisting source or target");
|
||||
|
||||
if (source > target)
|
||||
{
|
||||
std::swap(source, target);
|
||||
// std::swap(forward, backward);
|
||||
}
|
||||
|
||||
edge_list.emplace_back(source, target);
|
||||
}
|
||||
ext_to_int_id_map.clear();
|
||||
|
||||
tbb::parallel_sort(edge_list.begin(), edge_list.end());
|
||||
|
||||
// for (unsigned i = 1; i < edge_list.size(); ++i)
|
||||
// {
|
||||
// if ((edge_list[i - 1].target == edge_list[i].target) &&
|
||||
// (edge_list[i - 1].source == edge_list[i].source))
|
||||
// {
|
||||
// const bool edge_flags_equivalent = (edge_list[i - 1].forward == edge_list[i].forward)
|
||||
// &&
|
||||
// (edge_list[i - 1].backward ==
|
||||
// edge_list[i].backward);
|
||||
// const bool edge_flags_are_superset1 =
|
||||
// (edge_list[i - 1].forward && edge_list[i - 1].backward) &&
|
||||
// (edge_list[i].forward != edge_list[i].backward);
|
||||
// const bool edge_flags_are_superset_2 =
|
||||
// (edge_list[i].forward && edge_list[i].backward) &&
|
||||
// (edge_list[i - 1].forward != edge_list[i - 1].backward);
|
||||
|
||||
// if (edge_flags_equivalent)
|
||||
// {
|
||||
// edge_list[i].weight = std::min(edge_list[i - 1].weight, edge_list[i].weight);
|
||||
// edge_list[i - 1].source = SPECIAL_NODEID;
|
||||
// }
|
||||
// else if (edge_flags_are_superset1)
|
||||
// {
|
||||
// if (edge_list[i - 1].weight <= edge_list[i].weight)
|
||||
// {
|
||||
// // edge i-1 is smaller and goes in both directions. Throw away the other edge
|
||||
// edge_list[i].source = SPECIAL_NODEID;
|
||||
// }
|
||||
// else
|
||||
// {
|
||||
// // edge i-1 is open in both directions, but edge i is smaller in one
|
||||
// direction.
|
||||
// // Close edge i-1 in this direction
|
||||
// edge_list[i - 1].forward = !edge_list[i].forward;
|
||||
// edge_list[i - 1].backward = !edge_list[i].backward;
|
||||
// }
|
||||
// }
|
||||
// else if (edge_flags_are_superset_2)
|
||||
// {
|
||||
// if (edge_list[i - 1].weight <= edge_list[i].weight)
|
||||
// {
|
||||
// // edge i-1 is smaller for one direction. edge i is open in both. close edge
|
||||
// i
|
||||
// // in the other direction
|
||||
// edge_list[i].forward = !edge_list[i - 1].forward;
|
||||
// edge_list[i].backward = !edge_list[i - 1].backward;
|
||||
// }
|
||||
// else
|
||||
// {
|
||||
// // edge i is smaller and goes in both direction. Throw away edge i-1
|
||||
// edge_list[i - 1].source = SPECIAL_NODEID;
|
||||
// }
|
||||
// }
|
||||
// }
|
||||
// }
|
||||
// const auto new_end_iter =
|
||||
// std::remove_if(edge_list.begin(), edge_list.end(), [](const EdgeT &edge)
|
||||
// {
|
||||
// return edge.source == SPECIAL_NODEID || edge.target == SPECIAL_NODEID;
|
||||
// });
|
||||
// edge_list.erase(new_end_iter, edge_list.end()); // remove excess candidates.
|
||||
// edge_list.shrink_to_fit();
|
||||
SimpleLogger().Write() << "Graph loaded ok and has " << edge_list.size() << " edges";
|
||||
return n;
|
||||
}
|
||||
|
||||
template <typename EdgeT>
|
||||
NodeID readBinaryOSRMGraphFromStream(std::istream &input_stream,
|
||||
std::vector<EdgeT> &edge_list,
|
||||
std::vector<NodeID> &barrier_node_list,
|
||||
std::vector<NodeID> &traffic_light_node_list,
|
||||
std::vector<QueryNode> *int_to_ext_node_id_map,
|
||||
std::vector<TurnRestriction> &restriction_list)
|
||||
{
|
||||
const FingerPrint fingerprint_orig;
|
||||
FingerPrint fingerprint_loaded;
|
||||
input_stream.read(reinterpret_cast<char *>(&fingerprint_loaded), sizeof(FingerPrint));
|
||||
|
||||
if (!fingerprint_loaded.TestGraphUtil(fingerprint_orig))
|
||||
{
|
||||
SimpleLogger().Write(logWARNING) << ".osrm was prepared with different build.\n"
|
||||
"Reprocess to get rid of this warning.";
|
||||
}
|
||||
|
||||
std::unordered_map<NodeID, NodeID> ext_to_int_id_map;
|
||||
|
||||
NodeID n;
|
||||
input_stream.read(reinterpret_cast<char *>(&n), sizeof(NodeID));
|
||||
SimpleLogger().Write() << "Importing n = " << n << " nodes ";
|
||||
|
||||
ExternalMemoryNode current_node;
|
||||
for (NodeID i = 0; i < n; ++i)
|
||||
{
|
||||
input_stream.read(reinterpret_cast<char *>(¤t_node), sizeof(ExternalMemoryNode));
|
||||
int_to_ext_node_id_map->emplace_back(current_node.lat, current_node.lon,
|
||||
current_node.node_id);
|
||||
ext_to_int_id_map.emplace(current_node.node_id, i);
|
||||
if (current_node.barrier)
|
||||
{
|
||||
barrier_node_list.emplace_back(i);
|
||||
}
|
||||
if (current_node.traffic_lights)
|
||||
{
|
||||
traffic_light_node_list.emplace_back(i);
|
||||
}
|
||||
}
|
||||
|
||||
// tighten vector sizes
|
||||
barrier_node_list.shrink_to_fit();
|
||||
traffic_light_node_list.shrink_to_fit();
|
||||
|
||||
// renumber nodes in turn restrictions
|
||||
// renumber ids referenced in restrictions
|
||||
for (TurnRestriction ¤t_restriction : restriction_list)
|
||||
{
|
||||
auto internal_id_iter = ext_to_int_id_map.find(current_restriction.from.node);
|
||||
@@ -346,6 +111,70 @@ NodeID readBinaryOSRMGraphFromStream(std::istream &input_stream,
|
||||
current_restriction.to.node = internal_id_iter->second;
|
||||
}
|
||||
|
||||
return number_of_usable_restrictions;
|
||||
}
|
||||
|
||||
|
||||
/**
|
||||
* Reads the beginning of an .osrm file and produces:
|
||||
* - list of barrier nodes
|
||||
* - list of traffic lights
|
||||
* - index to original node id map
|
||||
* - original node id to index map
|
||||
*/
|
||||
NodeID loadNodesFromFile(std::istream &input_stream,
|
||||
std::vector<NodeID> &barrier_node_list,
|
||||
std::vector<NodeID> &traffic_light_node_list,
|
||||
std::vector<QueryNode> &int_to_ext_node_id_map,
|
||||
std::unordered_map<NodeID, NodeID> &ext_to_int_id_map)
|
||||
{
|
||||
const FingerPrint fingerprint_orig;
|
||||
FingerPrint fingerprint_loaded;
|
||||
input_stream.read(reinterpret_cast<char *>(&fingerprint_loaded), sizeof(FingerPrint));
|
||||
|
||||
if (!fingerprint_loaded.TestGraphUtil(fingerprint_orig))
|
||||
{
|
||||
SimpleLogger().Write(logWARNING) << ".osrm was prepared with different build.\n"
|
||||
"Reprocess to get rid of this warning.";
|
||||
}
|
||||
|
||||
NodeID n;
|
||||
input_stream.read(reinterpret_cast<char *>(&n), sizeof(NodeID));
|
||||
SimpleLogger().Write() << "Importing n = " << n << " nodes ";
|
||||
|
||||
ExternalMemoryNode current_node;
|
||||
for (NodeID i = 0; i < n; ++i)
|
||||
{
|
||||
input_stream.read(reinterpret_cast<char *>(¤t_node), sizeof(ExternalMemoryNode));
|
||||
int_to_ext_node_id_map.emplace_back(current_node.lat, current_node.lon,
|
||||
current_node.node_id);
|
||||
ext_to_int_id_map.emplace(current_node.node_id, i);
|
||||
if (current_node.barrier)
|
||||
{
|
||||
barrier_node_list.emplace_back(i);
|
||||
}
|
||||
if (current_node.traffic_lights)
|
||||
{
|
||||
traffic_light_node_list.emplace_back(i);
|
||||
}
|
||||
}
|
||||
|
||||
// tighten vector sizes
|
||||
barrier_node_list.shrink_to_fit();
|
||||
traffic_light_node_list.shrink_to_fit();
|
||||
|
||||
return n;
|
||||
}
|
||||
|
||||
/**
|
||||
* Reads a .osrm file and produces the edges. Edges reference nodes in the old
|
||||
* OSM based format, we need to renumber it here.
|
||||
*/
|
||||
template <typename EdgeT>
|
||||
NodeID loadEdgesFromFile(std::istream &input_stream,
|
||||
const std::unordered_map<NodeID, NodeID> &ext_to_int_id_map,
|
||||
std::vector<EdgeT> &edge_list)
|
||||
{
|
||||
EdgeWeight weight;
|
||||
NodeID source, target;
|
||||
unsigned nameID;
|
||||
@@ -419,10 +248,10 @@ NodeID readBinaryOSRMGraphFromStream(std::istream &input_stream,
|
||||
edge_list.emplace_back(source, target, nameID, weight, forward, backward, is_roundabout,
|
||||
ignore_in_grid, is_access_restricted, travel_mode, is_split);
|
||||
}
|
||||
ext_to_int_id_map.clear();
|
||||
|
||||
tbb::parallel_sort(edge_list.begin(), edge_list.end());
|
||||
|
||||
// Removes multi-edges between nodes
|
||||
for (unsigned i = 1; i < edge_list.size(); ++i)
|
||||
{
|
||||
if ((edge_list[i - 1].target == edge_list[i].target) &&
|
||||
@@ -482,7 +311,8 @@ NodeID readBinaryOSRMGraphFromStream(std::istream &input_stream,
|
||||
edge_list.erase(new_end_iter, edge_list.end()); // remove excess candidates.
|
||||
edge_list.shrink_to_fit();
|
||||
SimpleLogger().Write() << "Graph loaded ok and has " << edge_list.size() << " edges";
|
||||
return n;
|
||||
|
||||
return m;
|
||||
}
|
||||
|
||||
template <typename NodeT, typename EdgeT>
|
||||
|
||||
Reference in New Issue
Block a user