init.hpp

Go to the documentation of this file.

// Copyright Institute for Automotive Engineering (ika), RWTH Aachen University
// SPDX-License-Identifier: MIT
 
#pragma once
 
#include <perception_msgs_utils/constants.hpp>
#include <perception_msgs_utils/convenience_state_setters.hpp>
#include <perception_msgs_utils/utils.hpp>
 
 
namespace perception_msgs {
 
namespace object_access {
 
  inline void initializeState(ObjectState& state, const unsigned char& model_id) {
    state.model_id = model_id;
    setContinuousState(state, std::vector<double>(getContinuousStateSize(model_id), CONTINUOUS_STATE_INIT));
    setDiscreteState(state, std::vector<long int>(getDiscreteStateSize(model_id), DISCRETE_STATE_INIT));
    state.continuous_state_covariance.clear();
  }
 
  template <typename T>
  inline void initializeState(T& obj, const unsigned char& model_id) {
    initializeState(obj.state, model_id);
  }
 
} // namespace object_access
 
} // namespace perception_msgs