137 lines
5.4 KiB
C++
137 lines
5.4 KiB
C++
#ifndef OSRM_UTIL_GUIDANCE_TOOLKIT_HPP_
|
|
#define OSRM_UTIL_GUIDANCE_TOOLKIT_HPP_
|
|
|
|
/* A set of tools required for guidance in both pre and post-processing */
|
|
|
|
#include "extractor/guidance/turn_instruction.hpp"
|
|
#include "engine/guidance/route_step.hpp"
|
|
#include "engine/phantom_node.hpp"
|
|
#include "util/guidance/bearing_class.hpp"
|
|
#include "util/guidance/entry_class.hpp"
|
|
#include "util/simple_logger.hpp"
|
|
|
|
#include <algorithm>
|
|
#include <vector>
|
|
|
|
namespace osrm
|
|
{
|
|
namespace util
|
|
{
|
|
namespace guidance
|
|
{
|
|
|
|
inline double angularDeviation(const double angle, const double from)
|
|
{
|
|
const double deviation = std::abs(angle - from);
|
|
return std::min(360 - deviation, deviation);
|
|
}
|
|
|
|
inline extractor::guidance::DirectionModifier::Enum getTurnDirection(const double angle)
|
|
{
|
|
// An angle of zero is a u-turn
|
|
// 180 goes perfectly straight
|
|
// 0-180 are right turns
|
|
// 180-360 are left turns
|
|
if (angle > 0 && angle < 60)
|
|
return extractor::guidance::DirectionModifier::SharpRight;
|
|
if (angle >= 60 && angle < 140)
|
|
return extractor::guidance::DirectionModifier::Right;
|
|
if (angle >= 140 && angle < 170)
|
|
return extractor::guidance::DirectionModifier::SlightRight;
|
|
if (angle >= 165 && angle <= 195)
|
|
return extractor::guidance::DirectionModifier::Straight;
|
|
if (angle > 190 && angle <= 220)
|
|
return extractor::guidance::DirectionModifier::SlightLeft;
|
|
if (angle > 220 && angle <= 300)
|
|
return extractor::guidance::DirectionModifier::Left;
|
|
if (angle > 300 && angle < 360)
|
|
return extractor::guidance::DirectionModifier::SharpLeft;
|
|
return extractor::guidance::DirectionModifier::UTurn;
|
|
}
|
|
|
|
// swaps left <-> right modifier types
|
|
inline extractor::guidance::DirectionModifier::Enum
|
|
mirrorDirectionModifier(const extractor::guidance::DirectionModifier::Enum modifier)
|
|
{
|
|
const constexpr extractor::guidance::DirectionModifier::Enum results[] = {
|
|
extractor::guidance::DirectionModifier::UTurn,
|
|
extractor::guidance::DirectionModifier::SharpLeft,
|
|
extractor::guidance::DirectionModifier::Left,
|
|
extractor::guidance::DirectionModifier::SlightLeft,
|
|
extractor::guidance::DirectionModifier::Straight,
|
|
extractor::guidance::DirectionModifier::SlightRight,
|
|
extractor::guidance::DirectionModifier::Right,
|
|
extractor::guidance::DirectionModifier::SharpRight};
|
|
return results[modifier];
|
|
}
|
|
|
|
inline bool hasLeftModifier(const extractor::guidance::TurnInstruction instruction)
|
|
{
|
|
return instruction.direction_modifier == extractor::guidance::DirectionModifier::SharpLeft ||
|
|
instruction.direction_modifier == extractor::guidance::DirectionModifier::Left ||
|
|
instruction.direction_modifier == extractor::guidance::DirectionModifier::SlightLeft;
|
|
}
|
|
|
|
inline bool hasRightModifier(const extractor::guidance::TurnInstruction instruction)
|
|
{
|
|
return instruction.direction_modifier == extractor::guidance::DirectionModifier::SharpRight ||
|
|
instruction.direction_modifier == extractor::guidance::DirectionModifier::Right ||
|
|
instruction.direction_modifier == extractor::guidance::DirectionModifier::SlightRight;
|
|
}
|
|
|
|
inline bool isLeftTurn(const extractor::guidance::TurnInstruction instruction)
|
|
{
|
|
switch (instruction.type)
|
|
{
|
|
case extractor::guidance::TurnType::Merge:
|
|
return hasRightModifier(instruction);
|
|
default:
|
|
return hasLeftModifier(instruction);
|
|
}
|
|
}
|
|
|
|
inline bool isRightTurn(const extractor::guidance::TurnInstruction instruction)
|
|
{
|
|
switch (instruction.type)
|
|
{
|
|
case extractor::guidance::TurnType::Merge:
|
|
return hasLeftModifier(instruction);
|
|
default:
|
|
return hasRightModifier(instruction);
|
|
}
|
|
}
|
|
|
|
inline bool entersRoundabout(const extractor::guidance::TurnInstruction instruction)
|
|
{
|
|
return (instruction.type == extractor::guidance::TurnType::EnterRoundabout ||
|
|
instruction.type == extractor::guidance::TurnType::EnterRotary ||
|
|
instruction.type == extractor::guidance::TurnType::EnterRoundaboutIntersection ||
|
|
instruction.type == extractor::guidance::TurnType::EnterRoundaboutAtExit ||
|
|
instruction.type == extractor::guidance::TurnType::EnterRotaryAtExit ||
|
|
instruction.type == extractor::guidance::TurnType::EnterRoundaboutIntersectionAtExit ||
|
|
instruction.type == extractor::guidance::TurnType::EnterAndExitRoundabout ||
|
|
instruction.type == extractor::guidance::TurnType::EnterAndExitRotary ||
|
|
instruction.type == extractor::guidance::TurnType::EnterAndExitRotary);
|
|
}
|
|
|
|
inline bool leavesRoundabout(const extractor::guidance::TurnInstruction instruction)
|
|
{
|
|
return (instruction.type == extractor::guidance::TurnType::ExitRoundabout ||
|
|
instruction.type == extractor::guidance::TurnType::ExitRotary ||
|
|
instruction.type == extractor::guidance::TurnType::ExitRoundaboutIntersection ||
|
|
instruction.type == extractor::guidance::TurnType::EnterAndExitRoundabout ||
|
|
instruction.type == extractor::guidance::TurnType::EnterAndExitRotary ||
|
|
instruction.type == extractor::guidance::TurnType::EnterAndExitRoundaboutIntersection);
|
|
}
|
|
|
|
inline bool staysOnRoundabout(const extractor::guidance::TurnInstruction instruction)
|
|
{
|
|
return instruction.type == extractor::guidance::TurnType::StayOnRoundabout;
|
|
}
|
|
|
|
} // namespace guidance
|
|
} // namespace util
|
|
} // namespace osrm
|
|
|
|
#endif /* OSRM_UTIL_GUIDANCE_TOOLKIT_HPP_ */
|