11 #ifndef POSESENSORSTATETYPE_H
12 #define POSESENSORSTATETYPE_H
15 #include <Eigen/Dense>
22 EIGEN_MAKE_ALIGNED_OPERATOR_NEW
25 Eigen::Quaternion<double>
q_ip_;
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";
51 Eigen::Vector4d q_ip =
q_ip_.coeffs();
52 os <<
", " << q_ip(3) <<
", " << q_ip(0) <<
", " << q_ip(1) <<
", " << q_ip(2);
The BaseStates class is used to ensure that all sensor data classes define a covariance size for the ...
Definition: base_states.h:23
Definition: pose_sensor_state_type.h:20
std::string to_csv_string(const double ×tamp) const
Definition: pose_sensor_state_type.h:43
Eigen::Quaternion< double > q_ip_
Definition: pose_sensor_state_type.h:25
PoseSensorStateType()
Definition: pose_sensor_state_type.h:27
static std::string get_csv_state_header_string()
Definition: pose_sensor_state_type.h:33
EIGEN_MAKE_ALIGNED_OPERATOR_NEW Eigen::Vector3d p_ip_
Definition: pose_sensor_state_type.h:24