30a9bc3179
StaticRTree now uses projected coordinates internally. That means we can use a euclidean distance measure (squared distance) for sorting the query queue.
101 lines
2.5 KiB
C++
101 lines
2.5 KiB
C++
#include "util/coordinate_calculation.hpp"
|
|
|
|
#ifndef NDEBUG
|
|
#include "util/simple_logger.hpp"
|
|
#endif
|
|
#include "osrm/coordinate.hpp"
|
|
|
|
#ifndef NDEBUG
|
|
#include <bitset>
|
|
#endif
|
|
#include <iostream>
|
|
#include <iomanip>
|
|
#include <limits>
|
|
|
|
namespace osrm
|
|
{
|
|
namespace util
|
|
{
|
|
|
|
Coordinate::Coordinate()
|
|
: lon(std::numeric_limits<int>::min()), lat(std::numeric_limits<int>::min())
|
|
{
|
|
}
|
|
|
|
Coordinate::Coordinate(const FloatCoordinate &other)
|
|
: Coordinate(toFixed(other.lon), toFixed(other.lat))
|
|
{
|
|
}
|
|
|
|
Coordinate::Coordinate(const FloatLongitude lon_, const FloatLatitude lat_)
|
|
: Coordinate(toFixed(lon_), toFixed(lat_))
|
|
{
|
|
}
|
|
|
|
Coordinate::Coordinate(const FixedLongitude lon_, const FixedLatitude lat_) : lon(lon_), lat(lat_)
|
|
{
|
|
}
|
|
|
|
bool Coordinate::IsValid() const
|
|
{
|
|
return !(lat > FixedLatitude(90 * COORDINATE_PRECISION) ||
|
|
lat < FixedLatitude(-90 * COORDINATE_PRECISION) ||
|
|
lon > FixedLongitude(180 * COORDINATE_PRECISION) ||
|
|
lon < FixedLongitude(-180 * COORDINATE_PRECISION));
|
|
}
|
|
|
|
FloatCoordinate::FloatCoordinate()
|
|
: lon(std::numeric_limits<double>::min()), lat(std::numeric_limits<double>::min())
|
|
{
|
|
}
|
|
|
|
FloatCoordinate::FloatCoordinate(const Coordinate other)
|
|
: FloatCoordinate(toFloating(other.lon), toFloating(other.lat))
|
|
{
|
|
}
|
|
|
|
FloatCoordinate::FloatCoordinate(const FixedLongitude lon_, const FixedLatitude lat_)
|
|
: FloatCoordinate(toFloating(lon_), toFloating(lat_))
|
|
{
|
|
}
|
|
|
|
FloatCoordinate::FloatCoordinate(const FloatLongitude lon_, const FloatLatitude lat_) : lon(lon_), lat(lat_)
|
|
{
|
|
}
|
|
|
|
bool FloatCoordinate::IsValid() const
|
|
{
|
|
return !(lat > FloatLatitude(90) ||
|
|
lat < FloatLatitude(-90) ||
|
|
lon > FloatLongitude(180) ||
|
|
lon < FloatLongitude(-180));
|
|
}
|
|
|
|
|
|
bool operator==(const Coordinate lhs, const Coordinate rhs)
|
|
{
|
|
return lhs.lat == rhs.lat && lhs.lon == rhs.lon;
|
|
}
|
|
bool operator==(const FloatCoordinate lhs, const FloatCoordinate rhs)
|
|
{
|
|
return lhs.lat == rhs.lat && lhs.lon == rhs.lon;
|
|
}
|
|
|
|
bool operator!=(const Coordinate lhs, const Coordinate rhs) { return !(lhs == rhs); }
|
|
bool operator!=(const FloatCoordinate lhs, const FloatCoordinate rhs) { return !(lhs == rhs); }
|
|
|
|
std::ostream &operator<<(std::ostream &out, const Coordinate coordinate)
|
|
{
|
|
out << std::setprecision(12) << "(lon:" << toFloating(coordinate.lon)
|
|
<< ", lat:" << toFloating(coordinate.lat) << ")";
|
|
return out;
|
|
}
|
|
std::ostream &operator<<(std::ostream &out, const FloatCoordinate coordinate)
|
|
{
|
|
out << std::setprecision(12) << "(lon:" << coordinate.lon
|
|
<< ", lat:" << coordinate.lat << ")";
|
|
return out;
|
|
}
|
|
}
|
|
}
|