mars_lib  0.1.0.3dc76ee85e09
Modular and Robust Sensor-Fusion
Public Member Functions | Static Public Member Functions | Public Attributes | List of all members
mars::PoseSensorStateType Class Reference

#include </home/runner/work/mars_lib/mars_lib/source/mars/include/mars/sensors/pose/pose_sensor_state_type.h>

+ Inheritance diagram for mars::PoseSensorStateType:
+ Collaboration diagram for mars::PoseSensorStateType:

Public Member Functions

 PoseSensorStateType ()
 
std::string to_csv_string (const double &timestamp) const
 
- Public Member Functions inherited from mars::BaseStates
 BaseStates (int cov_size)
 

Static Public Member Functions

static std::string get_csv_state_header_string ()
 

Public Attributes

EIGEN_MAKE_ALIGNED_OPERATOR_NEW Eigen::Vector3d p_ip_
 
Eigen::Quaternion< double > q_ip_
 
- Public Attributes inherited from mars::BaseStates
int cov_size_
 

Constructor & Destructor Documentation

◆ PoseSensorStateType()

mars::PoseSensorStateType::PoseSensorStateType ( )
inline
27  : BaseStates(6) // size of covariance
28  {
29  p_ip_.setZero();
30  q_ip_.setIdentity();
31  }
BaseStates(int cov_size)
Definition: base_states.h:27
Eigen::Quaternion< double > q_ip_
Definition: pose_sensor_state_type.h:25
EIGEN_MAKE_ALIGNED_OPERATOR_NEW Eigen::Vector3d p_ip_
Definition: pose_sensor_state_type.h:24

Member Function Documentation

◆ get_csv_state_header_string()

static std::string mars::PoseSensorStateType::get_csv_state_header_string ( )
inlinestatic
34  {
35  std::stringstream os;
36  os << "t, ";
37  os << "p_ip_x, p_ip_y, p_ip_z, ";
38  os << "q_ip_w, q_ip_x, q_ip_y, q_ip_z";
39 
40  return os.str();
41  }

◆ to_csv_string()

std::string mars::PoseSensorStateType::to_csv_string ( const double &  timestamp) const
inline
44  {
45  std::stringstream os;
46  os.precision(17);
47  os << timestamp;
48 
49  os << ", " << p_ip_(0) << ", " << p_ip_(1) << ", " << p_ip_(2);
50 
51  Eigen::Vector4d q_ip = q_ip_.coeffs(); // x y z w
52  os << ", " << q_ip(3) << ", " << q_ip(0) << ", " << q_ip(1) << ", " << q_ip(2);
53 
54  return os.str();
55  }

Member Data Documentation

◆ p_ip_

EIGEN_MAKE_ALIGNED_OPERATOR_NEW Eigen::Vector3d mars::PoseSensorStateType::p_ip_

◆ q_ip_

Eigen::Quaternion<double> mars::PoseSensorStateType::q_ip_

The documentation for this class was generated from the following file: