mars_lib 0.1.0.2abe2576fe7f
Modular and Robust Sensor-Fusion
Loading...
Searching...
No Matches
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: