Patrick Niklaus
35 lines
1.0 KiB
C++
35 lines
1.0 KiB
C++
#include "util/compute_angle.hpp"
|
|
|
|
#include "util/trigonometry_table.hpp"
|
|
#include "util/mercator.hpp"
|
|
|
|
#include "osrm/coordinate.hpp"
|
|
|
|
#include <cmath>
|
|
|
|
namespace osrm
|
|
{
|
|
namespace util
|
|
{
|
|
|
|
double ComputeAngle::OfThreeFixedPointCoordinates(const FixedPointCoordinate &first,
|
|
const FixedPointCoordinate &second,
|
|
const FixedPointCoordinate &third) noexcept
|
|
{
|
|
const double v1x = (first.lon - second.lon) / COORDINATE_PRECISION;
|
|
const double v1y = mercator::lat2y(first.lat / COORDINATE_PRECISION) -
|
|
mercator::lat2y(second.lat / COORDINATE_PRECISION);
|
|
const double v2x = (third.lon - second.lon) / COORDINATE_PRECISION;
|
|
const double v2y = mercator::lat2y(third.lat / COORDINATE_PRECISION) -
|
|
mercator::lat2y(second.lat / COORDINATE_PRECISION);
|
|
|
|
double angle = (atan2_lookup(v2y, v2x) - atan2_lookup(v1y, v1x)) * 180. / M_PI;
|
|
while (angle < 0.)
|
|
{
|
|
angle += 360.;
|
|
}
|
|
return angle;
|
|
}
|
|
}
|
|
}
|