perception_interfaces 1.2.0
Loading...
Searching...
No Matches
Functions
init.hpp File Reference

Object state initializers. More...

#include <perception_msgs_utils/constants.hpp>
#include <perception_msgs_utils/convenience_state_setters.hpp>
#include <perception_msgs_utils/utils.hpp>

Go to the source code of this file.

Functions

void perception_msgs::object_access::initializeState (ObjectState &state, const unsigned char &model_id)
 Initialize an object state with empty covariance storage. Covariance getters expose INVALID diagonals and zero cross terms.
 
template<typename T >
void perception_msgs::object_access::initializeState (T &obj, const unsigned char &model_id)
 This function initializes a given template object that contains an object state.
 

Detailed Description

Object state initializers.

Definition in file init.hpp.

Function Documentation

◆ initializeState() [1/2]

void perception_msgs::object_access::initializeState ( ObjectState &  state,
const unsigned char &  model_id 
)
inline

Initialize an object state with empty covariance storage. Covariance getters expose INVALID diagonals and zero cross terms.

Parameters
state
model_id

Definition at line 27 of file init.hpp.

27 {
28 state.model_id = model_id;
29 setContinuousState(state, std::vector<double>(getContinuousStateSize(model_id), CONTINUOUS_STATE_INIT));
30 setDiscreteState(state, std::vector<long int>(getDiscreteStateSize(model_id), DISCRETE_STATE_INIT));
31 state.continuous_state_covariance.clear();
32 }
void setContinuousState(ObjectState &state, const std::vector< double > &val)
Set the continuous state of a given object state.
void setDiscreteState(ObjectState &state, const std::vector< long int > &val)
Set the discrete state of a given object state.
int getDiscreteStateSize(const ObjectState &state)
Get the discrete state size for a given object state.
Definition utils.hpp:75
int getContinuousStateSize(const ObjectState &state)
Get the continuous state size for a given object state.
Definition utils.hpp:30

◆ initializeState() [2/2]

template<typename T >
void perception_msgs::object_access::initializeState ( T &  obj,
const unsigned char &  model_id 
)
inline

This function initializes a given template object that contains an object state.

Template Parameters
T
Parameters
obj
model_id

Definition at line 42 of file init.hpp.

42 {
43 initializeState(obj.state, model_id);
44 }
void initializeState(ObjectState &state, const unsigned char &model_id)
Initialize an object state with empty covariance storage. Covariance getters expose INVALID diagonals...
Definition init.hpp:27