Collapse computeAngle into coordinate calculation
This commit is contained in:
parent
0fcca04150
commit
46fc6f8da4
@ -10,7 +10,7 @@
|
|||||||
#include "engine/guidance/segment_list.hpp"
|
#include "engine/guidance/segment_list.hpp"
|
||||||
#include "engine/api_response_generator.hpp"
|
#include "engine/api_response_generator.hpp"
|
||||||
#include "engine/routing_algorithms/map_matching.hpp"
|
#include "engine/routing_algorithms/map_matching.hpp"
|
||||||
#include "util/compute_angle.hpp"
|
#include "util/coordinate_calculation.hpp"
|
||||||
#include "util/integer_range.hpp"
|
#include "util/integer_range.hpp"
|
||||||
#include "util/json_logger.hpp"
|
#include "util/json_logger.hpp"
|
||||||
#include "util/json_util.hpp"
|
#include "util/json_util.hpp"
|
||||||
@ -108,9 +108,9 @@ template <class DataFacadeT> class MapMatchingPlugin : public BasePlugin
|
|||||||
|
|
||||||
if (input_coords.size() - 1 > current_coordinate && 0 < current_coordinate)
|
if (input_coords.size() - 1 > current_coordinate && 0 < current_coordinate)
|
||||||
{
|
{
|
||||||
double turn_angle = util::ComputeAngle(input_coords[current_coordinate - 1],
|
double turn_angle = util::coordinate_calculation::computeAngle(
|
||||||
input_coords[current_coordinate],
|
input_coords[current_coordinate - 1], input_coords[current_coordinate],
|
||||||
input_coords[current_coordinate + 1]);
|
input_coords[current_coordinate + 1]);
|
||||||
|
|
||||||
// sharp turns indicate a possible uturn
|
// sharp turns indicate a possible uturn
|
||||||
if (turn_angle <= 90.0 || turn_angle >= 270.0)
|
if (turn_angle <= 90.0 || turn_angle >= 270.0)
|
||||||
|
@ -1,37 +0,0 @@
|
|||||||
#ifndef COMPUTE_ANGLE_HPP
|
|
||||||
#define COMPUTE_ANGLE_HPP
|
|
||||||
|
|
||||||
#include "osrm/coordinate.hpp"
|
|
||||||
#include "util/trigonometry_table.hpp"
|
|
||||||
#include "util/mercator.hpp"
|
|
||||||
|
|
||||||
namespace osrm
|
|
||||||
{
|
|
||||||
namespace util
|
|
||||||
{
|
|
||||||
|
|
||||||
// Get angle of line segment (A,C)->(C,B)
|
|
||||||
inline double ComputeAngle(const FixedPointCoordinate first,
|
|
||||||
const FixedPointCoordinate second,
|
|
||||||
const FixedPointCoordinate third) noexcept
|
|
||||||
{
|
|
||||||
const double v1x = (first.lon - second.lon) / COORDINATE_PRECISION;
|
|
||||||
const double v1y = mercator::latToY(first.lat / COORDINATE_PRECISION) -
|
|
||||||
mercator::latToY(second.lat / COORDINATE_PRECISION);
|
|
||||||
const double v2x = (third.lon - second.lon) / COORDINATE_PRECISION;
|
|
||||||
const double v2y = mercator::latToY(third.lat / COORDINATE_PRECISION) -
|
|
||||||
mercator::latToY(second.lat / COORDINATE_PRECISION);
|
|
||||||
|
|
||||||
double angle = (atan2_lookup(v2y, v2x) - atan2_lookup(v1y, v1x)) * 180. / M_PI;
|
|
||||||
|
|
||||||
while (angle < 0.)
|
|
||||||
{
|
|
||||||
angle += 360.;
|
|
||||||
}
|
|
||||||
|
|
||||||
return angle;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
#endif // COMPUTE_ANGLE_HPP
|
|
@ -57,6 +57,11 @@ double radToDeg(const double radian);
|
|||||||
|
|
||||||
double bearing(const FixedPointCoordinate &first_coordinate,
|
double bearing(const FixedPointCoordinate &first_coordinate,
|
||||||
const FixedPointCoordinate &second_coordinate);
|
const FixedPointCoordinate &second_coordinate);
|
||||||
|
|
||||||
|
// Get angle of line segment (A,C)->(C,B)
|
||||||
|
double computeAngle(const FixedPointCoordinate &first,
|
||||||
|
const FixedPointCoordinate &second,
|
||||||
|
const FixedPointCoordinate &third);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -2,7 +2,6 @@
|
|||||||
#include "extractor/edge_based_graph_factory.hpp"
|
#include "extractor/edge_based_graph_factory.hpp"
|
||||||
#include "util/coordinate_calculation.hpp"
|
#include "util/coordinate_calculation.hpp"
|
||||||
#include "util/percent.hpp"
|
#include "util/percent.hpp"
|
||||||
#include "util/compute_angle.hpp"
|
|
||||||
#include "util/integer_range.hpp"
|
#include "util/integer_range.hpp"
|
||||||
#include "util/lua_util.hpp"
|
#include "util/lua_util.hpp"
|
||||||
#include "util/simple_logger.hpp"
|
#include "util/simple_logger.hpp"
|
||||||
@ -336,7 +335,7 @@ void EdgeBasedGraphFactory::GenerateEdgeExpandedNodes()
|
|||||||
}
|
}
|
||||||
|
|
||||||
BOOST_ASSERT(m_edge_based_node_list.size() == m_edge_based_node_is_startpoint.size());
|
BOOST_ASSERT(m_edge_based_node_list.size() == m_edge_based_node_is_startpoint.size());
|
||||||
BOOST_ASSERT(m_max_edge_id+1 == m_edge_based_node_weights.size());
|
BOOST_ASSERT(m_max_edge_id + 1 == m_edge_based_node_weights.size());
|
||||||
|
|
||||||
util::SimpleLogger().Write() << "Generated " << m_edge_based_node_list.size()
|
util::SimpleLogger().Write() << "Generated " << m_edge_based_node_list.size()
|
||||||
<< " nodes in edge-expanded graph";
|
<< " nodes in edge-expanded graph";
|
||||||
@ -498,7 +497,7 @@ void EdgeBasedGraphFactory::GenerateEdgeExpandedEdges(
|
|||||||
? m_compressed_edge_container.GetFirstEdgeTargetID(e2)
|
? m_compressed_edge_container.GetFirstEdgeTargetID(e2)
|
||||||
: node_w)];
|
: node_w)];
|
||||||
|
|
||||||
const double turn_angle = util::ComputeAngle(
|
const double turn_angle = util::coordinate_calculation::computeAngle(
|
||||||
first_coordinate, m_node_info_list[node_v], third_coordinate);
|
first_coordinate, m_node_info_list[node_v], third_coordinate);
|
||||||
|
|
||||||
const int turn_penalty = GetTurnPenalty(turn_angle, lua_state);
|
const int turn_penalty = GetTurnPenalty(turn_angle, lua_state);
|
||||||
|
@ -2,6 +2,7 @@
|
|||||||
|
|
||||||
#include "util/mercator.hpp"
|
#include "util/mercator.hpp"
|
||||||
#include "util/string_util.hpp"
|
#include "util/string_util.hpp"
|
||||||
|
#include "util/trigonometry_table.hpp"
|
||||||
|
|
||||||
#include <boost/assert.hpp>
|
#include <boost/assert.hpp>
|
||||||
|
|
||||||
@ -218,6 +219,27 @@ double bearing(const FixedPointCoordinate &first_coordinate,
|
|||||||
}
|
}
|
||||||
return result;
|
return result;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
double computeAngle(const FixedPointCoordinate &first,
|
||||||
|
const FixedPointCoordinate &second,
|
||||||
|
const FixedPointCoordinate &third)
|
||||||
|
{
|
||||||
|
const double v1x = (first.lon - second.lon) / COORDINATE_PRECISION;
|
||||||
|
const double v1y = mercator::latToY(first.lat / COORDINATE_PRECISION) -
|
||||||
|
mercator::latToY(second.lat / COORDINATE_PRECISION);
|
||||||
|
const double v2x = (third.lon - second.lon) / COORDINATE_PRECISION;
|
||||||
|
const double v2y = mercator::latToY(third.lat / COORDINATE_PRECISION) -
|
||||||
|
mercator::latToY(second.lat / COORDINATE_PRECISION);
|
||||||
|
|
||||||
|
double angle = (atan2_lookup(v2y, v2x) - atan2_lookup(v1y, v1x)) * 180. / M_PI;
|
||||||
|
|
||||||
|
while (angle < 0.)
|
||||||
|
{
|
||||||
|
angle += 360.;
|
||||||
|
}
|
||||||
|
|
||||||
|
return angle;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user