ParametricRangeAttributeOperation.hpp

Go to the documentation of this file.

// ----------------- BEGIN LICENSE BLOCK ---------------------------------
//
// Copyright (C) 2018-2021 Intel Corporation
//
// SPDX-License-Identifier: MIT
//
// ----------------- END LICENSE BLOCK -----------------------------------
#pragma once
 
#include "ad/map/restriction/SpeedLimit.hpp"
#include "ad/physics/RangeOperation.hpp"
 
namespace ad {
namespace map {
namespace restriction {
 
inline bool areAttributesEqual(SpeedLimit const &left, SpeedLimit const &right)
{
  return left.speedLimit == right.speedLimit;
}
 
template <typename RangeAttribute> bool combineRangeAttributes(RangeAttribute &left, RangeAttribute const &right)
{
  if (areAttributesEqual(left, right))
  {
    return extendRangeWith(left.lanePiece, right.lanePiece);
  }
  return false;
}
 
template <typename RangeAttribute>
bool doesRangeAttributeOverlap(std::vector<RangeAttribute> const &attributeList, RangeAttribute const &attribute)
{
  for (auto const &listEntry : attributeList)
  {
    if (doRangesOverlap(attribute.lanePiece, listEntry.lanePiece)
        && !doesRangePredate(attribute.lanePiece, listEntry.lanePiece)
        && !doesRangeSucceed(attribute.lanePiece, listEntry.lanePiece))
    {
      return true;
    }
  }
  return false;
}
 
template <typename RangeAttribute>
void insertRangeAttribute(std::vector<RangeAttribute> &attributeList, RangeAttribute const &attribute)
{
  for (auto it = attributeList.begin(); it != attributeList.end(); it++)
  {
    if (attribute.lanePiece <= it->lanePiece)
    {
      attributeList.insert(it, attribute);
      optimizeRangeAttributeList(attributeList);
      return;
    }
  }
  attributeList.push_back(attribute);
  optimizeRangeAttributeList(attributeList);
}
 
template <typename RangeAttribute> void optimizeRangeAttributeList(std::vector<RangeAttribute> &attributeList)
{
  for (auto it = attributeList.begin(); it != attributeList.end();)
  {
    auto it1 = it + 1;
    if (it1 == attributeList.end())
    {
      return;
    }
    if (combineRangeAttributes(*it, *it1))
    {
      attributeList.erase(it1);
    }
    else
    {
      it = it1;
    }
  }
}
 
} // namespace restriction
} // namespace map
} // namespace ad