mirror of
https://codeberg.org/comaps/comaps
synced 2025-12-23 22:53:43 +00:00
Organic Maps sources as of 02.04.2025 (fad26bbf22ac3da75e01e62aa01e5c8e11861005)
To expand with full Organic Maps and Maps.ME commits history run: git remote add om-historic [om-historic.git repo url] git fetch --tags om-historic git replace squashed-history historic-commits
This commit is contained in:
113
routing/pedestrian_directions.cpp
Normal file
113
routing/pedestrian_directions.cpp
Normal file
@@ -0,0 +1,113 @@
|
||||
#include "routing/pedestrian_directions.hpp"
|
||||
|
||||
#include "routing/turns_generator.hpp"
|
||||
#include "routing/turns.hpp"
|
||||
#include "routing/turns_generator_utils.hpp"
|
||||
|
||||
#include <utility>
|
||||
|
||||
namespace routing
|
||||
{
|
||||
using namespace std;
|
||||
using namespace turns;
|
||||
|
||||
PedestrianDirectionsEngine::PedestrianDirectionsEngine(MwmDataSource & dataSource, shared_ptr<NumMwmIds> numMwmIds)
|
||||
: DirectionsEngine(dataSource, std::move(numMwmIds))
|
||||
{
|
||||
}
|
||||
|
||||
// Angles in degrees for finding route segments with no actual forks.
|
||||
double constexpr kMaxForwardAngleCandidates = 95.0;
|
||||
double constexpr kMaxForwardAngleActual = 60.0;
|
||||
|
||||
size_t PedestrianDirectionsEngine::GetTurnDirection(IRoutingResult const & result, size_t const outgoingSegmentIndex,
|
||||
NumMwmIds const & numMwmIds,
|
||||
RoutingSettings const & vehicleSettings, TurnItem & turn)
|
||||
{
|
||||
if (outgoingSegmentIndex == result.GetSegments().size())
|
||||
{
|
||||
turn.m_pedestrianTurn = PedestrianDirection::ReachedYourDestination;
|
||||
return 0;
|
||||
}
|
||||
|
||||
// See comment for the same in CarDirectionsEngine::GetTurnDirection().
|
||||
if (outgoingSegmentIndex == 2) // The same as turnItem.m_index == 2.
|
||||
return 0;
|
||||
|
||||
TurnInfo turnInfo;
|
||||
if (!GetTurnInfo(result, outgoingSegmentIndex, vehicleSettings, turnInfo))
|
||||
return 0;
|
||||
|
||||
double const turnAngle = CalcTurnAngle(result, outgoingSegmentIndex, numMwmIds, vehicleSettings);
|
||||
|
||||
turn.m_pedestrianTurn = PedestrianDirection::None;
|
||||
|
||||
ASSERT_GREATER(turnInfo.m_ingoing->m_path.size(), 1, ());
|
||||
|
||||
TurnCandidates nodes;
|
||||
size_t ingoingCount = 0;
|
||||
m2::PointD const junctionPoint = turnInfo.m_ingoing->m_path.back().GetPoint();
|
||||
result.GetPossibleTurns(turnInfo.m_ingoing->m_segmentRange, junctionPoint, ingoingCount, nodes);
|
||||
if (nodes.isCandidatesAngleValid)
|
||||
{
|
||||
ASSERT(is_sorted(nodes.candidates.begin(), nodes.candidates.end(), base::LessBy(&TurnCandidate::m_angle)),
|
||||
("Turn candidates should be sorted by its angle field."));
|
||||
}
|
||||
|
||||
/// @todo Proper handling of isCandidatesAngleValid == False, when we don't have angles of candidates.
|
||||
|
||||
if (nodes.candidates.size() == 0)
|
||||
return 0;
|
||||
|
||||
turn.m_pedestrianTurn = IntermediateDirectionPedestrian(turnAngle);
|
||||
|
||||
if (turn.m_pedestrianTurn == PedestrianDirection::GoStraight)
|
||||
{
|
||||
turn.m_pedestrianTurn = PedestrianDirection::None;
|
||||
return 0;
|
||||
}
|
||||
|
||||
Segment firstOutgoingSeg;
|
||||
if (!turnInfo.m_outgoing->m_segmentRange.GetFirstSegment(numMwmIds, firstOutgoingSeg))
|
||||
return 0;
|
||||
|
||||
CorrectCandidatesSegmentByOutgoing(turnInfo, firstOutgoingSeg, nodes);
|
||||
RemoveUTurnCandidate(turnInfo, numMwmIds, nodes.candidates);
|
||||
|
||||
// If there is no fork on the road we don't need to generate any turn. It is pointless because
|
||||
// there is no possibility of leaving the route.
|
||||
if (nodes.candidates.size() <= 1)
|
||||
turn.m_pedestrianTurn = PedestrianDirection::None;
|
||||
if (fabs(CalcOneSegmentTurnAngle(turnInfo)) < kMaxForwardAngleActual && HasSingleForwardTurn(nodes, kMaxForwardAngleCandidates))
|
||||
turn.m_pedestrianTurn = PedestrianDirection::None;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void PedestrianDirectionsEngine::FixupTurns(vector<RouteSegment> & routeSegments)
|
||||
{
|
||||
double const kMergeDistMeters = 15.0;
|
||||
|
||||
for (size_t idx = 0; idx < routeSegments.size(); ++idx)
|
||||
{
|
||||
auto const & turn = routeSegments[idx].GetTurn();
|
||||
if (turn.IsTurnNone())
|
||||
continue;
|
||||
|
||||
bool const prevStepNoTurn =
|
||||
idx > 0 && routeSegments[idx - 1].GetTurn().m_pedestrianTurn == PedestrianDirection::GoStraight;
|
||||
bool const needToTurn = routeSegments[idx].GetTurn().m_pedestrianTurn == PedestrianDirection::TurnLeft ||
|
||||
routeSegments[idx].GetTurn().m_pedestrianTurn == PedestrianDirection::TurnRight;
|
||||
|
||||
// Merging turns which are closer to each other under some circumstance.
|
||||
if (prevStepNoTurn && needToTurn)
|
||||
{
|
||||
auto const & junction = routeSegments[idx].GetJunction();
|
||||
auto const & prevJunction = routeSegments[idx - 1].GetJunction();
|
||||
if (mercator::DistanceOnEarth(junction.GetPoint(), prevJunction.GetPoint()) < kMergeDistMeters)
|
||||
routeSegments[idx - 1].ClearTurn();
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
} // namespace routing
|
||||
Reference in New Issue
Block a user