ObjectStateValidInputRange.hpp

Go to the documentation of this file.

/*
 * ----------------- BEGIN LICENSE BLOCK ---------------------------------
 *
 * Copyright (C) 2018-2022 Intel Corporation
 *
 * SPDX-License-Identifier: LGPL-2.1-only
 *
 * ----------------- END LICENSE BLOCK -----------------------------------
 */
 
#pragma once
 
#include <cmath>
#include <limits>
#include "ad/physics/AngleValidInputRange.hpp"
#include "ad/physics/AngularVelocityValidInputRange.hpp"
#include "ad/physics/Dimension2DValidInputRange.hpp"
#include "ad/physics/Distance2DValidInputRange.hpp"
#include "ad/physics/SpeedRangeValidInputRange.hpp"
#include "ad/rss/world/ObjectState.hpp"
#include "spdlog/fmt/ostr.h"
#include "spdlog/spdlog.h"
 
inline bool withinValidInputRange(::ad::rss::world::ObjectState const &input, bool const logErrors = true)
{
  // check for generic member input ranges
  bool inValidInputRange = true;
  inValidInputRange = withinValidInputRange(input.yaw, logErrors) && withinValidInputRange(input.dimension, logErrors)
    && withinValidInputRange(input.yaw_rate, logErrors) && withinValidInputRange(input.center_point, logErrors)
    && withinValidInputRange(input.speed_range, logErrors) && withinValidInputRange(input.steering_angle, logErrors);
  if (!inValidInputRange && logErrors)
  {
    spdlog::error("withinValidInputRange(::ad::rss::world::ObjectState)>> {} has invalid member",
                  input); // LCOV_EXCL_BR_LINE
  }
 
  return inValidInputRange;
}