86fd04e556
Before we only worked on subsequent quick turns, as in: `right, right` keeps the user on the rightmost lanes. This changeset modifies the logic to work on any subsequent steps that are "quick" and have lane information we can constrain later. Because we do not have a from-lane => to-lanes mapping we take the lanes left and right of the turn lanes into account when heuristically assigning the leftmost / rightmost lanes. There are some edge cases where this still does not give us the optimal solution but it gets close to what is actually possible at the moment without having a lane mapping in post-processing. References: - https://github.com/Project-OSRM/osrm-backend/issues/2625 fix rebase
113 lines
3.7 KiB
C++
113 lines
3.7 KiB
C++
#ifndef OSRM_ENGINE_GUIDANCE_DEBUG_HPP_
|
|
#define OSRM_ENGINE_GUIDANCE_DEBUG_HPP_
|
|
|
|
#include "extractor/guidance/intersection.hpp"
|
|
#include "extractor/guidance/turn_lane_data.hpp"
|
|
#include "extractor/query_node.hpp"
|
|
#include "engine/guidance/route_step.hpp"
|
|
#include "util/node_based_graph.hpp"
|
|
#include "util/typedefs.hpp"
|
|
|
|
#include <iomanip>
|
|
#include <iostream>
|
|
#include <vector>
|
|
|
|
namespace osrm
|
|
{
|
|
namespace util
|
|
{
|
|
namespace guidance
|
|
{
|
|
inline void print(const engine::guidance::RouteStep &step)
|
|
{
|
|
std::cout << static_cast<int>(step.maneuver.instruction.type) << " "
|
|
<< static_cast<int>(step.maneuver.instruction.direction_modifier) << " "
|
|
<< static_cast<int>(step.maneuver.waypoint_type) << " "
|
|
<< " Duration: " << step.duration << " Distance: " << step.distance
|
|
<< " Geometry: " << step.geometry_begin << " " << step.geometry_end
|
|
<< "\n\tIntersections: " << step.intersections.size() << " [";
|
|
|
|
for (const auto &intersection : step.intersections)
|
|
{
|
|
std::cout << "(Lanes: " << static_cast<int>(intersection.lanes.lanes_in_turn) << " "
|
|
<< static_cast<int>(intersection.lanes.first_lane_from_the_right)
|
|
<< " bearings:";
|
|
for (auto bearing : intersection.bearings)
|
|
std::cout << " " << bearing;
|
|
std::cout << ", entry: ";
|
|
for (auto entry : intersection.entry)
|
|
std::cout << " " << (entry ? "true" : "false");
|
|
std::cout << ")";
|
|
}
|
|
std::cout << "] name[" << step.name_id << "]: " << step.name;
|
|
}
|
|
|
|
inline void print(const std::vector<engine::guidance::RouteStep> &steps)
|
|
{
|
|
std::cout << "Path\n";
|
|
int segment = 0;
|
|
for (const auto &step : steps)
|
|
{
|
|
std::cout << "\t[" << segment++ << "]: ";
|
|
print(step);
|
|
std::cout << std::endl;
|
|
}
|
|
}
|
|
|
|
inline void print(const extractor::guidance::Intersection &intersection)
|
|
{
|
|
std::cout << " Intersection:\n";
|
|
for (const auto &road : intersection)
|
|
std::cout << "\t" << toString(road) << "\n";
|
|
std::cout << std::flush;
|
|
}
|
|
|
|
inline void print(const NodeBasedDynamicGraph &node_based_graph,
|
|
const extractor::guidance::Intersection &intersection)
|
|
{
|
|
std::cout << " Intersection:\n";
|
|
for (const auto &road : intersection)
|
|
{
|
|
std::cout << "\t" << toString(road) << "\n";
|
|
std::cout << "\t\t"
|
|
<< node_based_graph.GetEdgeData(road.turn.eid).road_classification.ToString()
|
|
<< "\n";
|
|
}
|
|
std::cout << std::flush;
|
|
}
|
|
|
|
inline void print(const extractor::guidance::lanes::LaneDataVector &turn_lane_data)
|
|
{
|
|
std::cout << " Tags:\n";
|
|
for (auto entry : turn_lane_data)
|
|
std::cout << "\t" << entry.tag << "("
|
|
<< extractor::guidance::TurnLaneType::toString(entry.tag)
|
|
<< ") from: " << static_cast<int>(entry.from)
|
|
<< " to: " << static_cast<int>(entry.to)
|
|
<< " Can Be Suppresssed: " << (entry.suppress_assignment ? "true" : "false")
|
|
<< "\n";
|
|
std::cout << std::flush;
|
|
}
|
|
|
|
inline void
|
|
printTurnAssignmentData(const NodeID at,
|
|
const extractor::guidance::lanes::LaneDataVector &turn_lane_data,
|
|
const extractor::guidance::Intersection &intersection,
|
|
const std::vector<extractor::QueryNode> &node_info_list)
|
|
{
|
|
std::cout << "[Turn Assignment Progress]\nLocation:";
|
|
auto coordinate = node_info_list[at];
|
|
std::cout << std::setprecision(12) << toFloating(coordinate.lat) << " "
|
|
<< toFloating(coordinate.lon) << "\n";
|
|
|
|
print(intersection);
|
|
// flushes as well
|
|
print(turn_lane_data);
|
|
}
|
|
|
|
} // namespace guidance
|
|
} // namespace util
|
|
} // namespace osrm
|
|
|
|
#endif /*OSRM_ENGINE_GUIDANCE_DEBUG_HPP_*/
|