githubmirror/omim

routing/route_weight.cpp
103 строки4 KB
gmoryes
[routing] access:conditional in routing
06 мар 2020, 16:47
06 мар 2020, 16:475e726cd
#include "routing/route_weight.hpp"

#include "routing/cross_mwm_connector.hpp"

#include <type_traits>

using namespace std;

namespace
{
template <typename Number, typename EnableIf = enable_if_t<is_integral<Number>::value, void>>
bool SumWillOverflow(Number lhs, Number rhs)
{
  if (lhs > 0)
    return rhs > numeric_limits<Number>::max() - lhs;
  if (lhs < 0)
    return rhs < numeric_limits<Number>::min() - lhs;
  return false;
}
}  // namespace

namespace routing
{
double RouteWeight::ToCrossMwmWeight() const
{
  if (m_numPassThroughChanges > 0 || m_numAccessChanges > 0)
    return connector::kNoRoute;
  return GetWeight();
}

RouteWeight RouteWeight::operator+(RouteWeight const & rhs) const
{
  ASSERT(!SumWillOverflow(m_numPassThroughChanges, rhs.m_numPassThroughChanges),
         (m_numPassThroughChanges, rhs.m_numPassThroughChanges));
  ASSERT(!SumWillOverflow(m_numAccessChanges, rhs.m_numAccessChanges),
         (m_numAccessChanges, rhs.m_numAccessChanges));
  ASSERT(!SumWillOverflow(m_numAccessConditionalPenalties, rhs.m_numAccessConditionalPenalties),
         (m_numAccessConditionalPenalties, rhs.m_numAccessConditionalPenalties));

  return RouteWeight(m_weight + rhs.m_weight, m_numPassThroughChanges + rhs.m_numPassThroughChanges,
                     m_numAccessChanges + rhs.m_numAccessChanges,
                     m_numAccessConditionalPenalties + rhs.m_numAccessConditionalPenalties,
                     m_transitTime + rhs.m_transitTime);
}

RouteWeight RouteWeight::operator-(RouteWeight const & rhs) const
{
  ASSERT_NOT_EQUAL(m_numPassThroughChanges, numeric_limits<int8_t>::min(), ());
  ASSERT_NOT_EQUAL(m_numAccessChanges, numeric_limits<int8_t>::min(), ());
  ASSERT(
      !SumWillOverflow(m_numPassThroughChanges, static_cast<int8_t>(-rhs.m_numPassThroughChanges)),
      (m_numPassThroughChanges, -rhs.m_numPassThroughChanges));
  ASSERT(!SumWillOverflow(m_numAccessChanges, static_cast<int8_t>(-rhs.m_numAccessChanges)),
         (m_numAccessChanges, -rhs.m_numAccessChanges));
  ASSERT(!SumWillOverflow(m_numAccessConditionalPenalties,
                          static_cast<int8_t>(-rhs.m_numAccessConditionalPenalties)),
         (m_numAccessConditionalPenalties, -rhs.m_numAccessConditionalPenalties));

  return RouteWeight(m_weight - rhs.m_weight, m_numPassThroughChanges - rhs.m_numPassThroughChanges,
                     m_numAccessChanges - rhs.m_numAccessChanges,
                     m_numAccessConditionalPenalties - rhs.m_numAccessConditionalPenalties,
                     m_transitTime - rhs.m_transitTime);
}

RouteWeight & RouteWeight::operator+=(RouteWeight const & rhs)
{
  ASSERT(!SumWillOverflow(m_numPassThroughChanges, rhs.m_numPassThroughChanges),
         (m_numPassThroughChanges, rhs.m_numPassThroughChanges));
  ASSERT(!SumWillOverflow(m_numAccessChanges, rhs.m_numAccessChanges),
         (m_numAccessChanges, rhs.m_numAccessChanges));
  ASSERT(!SumWillOverflow(m_numAccessConditionalPenalties, rhs.m_numAccessConditionalPenalties),
         (m_numAccessConditionalPenalties, rhs.m_numAccessConditionalPenalties));
  m_weight += rhs.m_weight;
  m_numPassThroughChanges += rhs.m_numPassThroughChanges;
  m_numAccessChanges += rhs.m_numAccessChanges;
  m_numAccessConditionalPenalties += rhs.m_numAccessConditionalPenalties;
  m_transitTime += rhs.m_transitTime;
  return *this;
}

void RouteWeight::AddAccessConditionalPenalty()
{
  ASSERT_LESS(m_numAccessConditionalPenalties,
              std::numeric_limits<decltype(m_numAccessConditionalPenalties)>::max(), ());
  ++m_numAccessConditionalPenalties;
}

ostream & operator<<(ostream & os, RouteWeight const & routeWeight)
{
  os << "(" << static_cast<int32_t>(routeWeight.GetNumPassThroughChanges()) << ", "
     << static_cast<int32_t>(routeWeight.GetNumAccessChanges()) << ", "
     << static_cast<int32_t>(routeWeight.GetNumAccessConditionalPenalties()) << ", "
     << routeWeight.GetWeight() << ", " << routeWeight.GetTransitTime() << ")";
  return os;
}

RouteWeight operator*(double lhs, RouteWeight const & rhs)
{
  return RouteWeight(lhs * rhs.GetWeight(), rhs.GetNumPassThroughChanges(),
                     rhs.GetNumAccessChanges(), rhs.GetNumAccessConditionalPenalties(),
                     lhs * rhs.GetTransitTime());
}
}  // namespace routing