ImuMeasurement.h
Go to the documentation of this file.
1 #pragma once
2 
3 #include <tests/Measurement.h>
4 
5 namespace gtsam {
6 
10 class ImuMeasurement : public Measurement {
11  public:
12  enum Name { BODY = 0, RF_FOOT = 1, RH_FOOT = 2 };
13 
15  Eigen::Vector3d I_a_WI;
16  Eigen::Vector3d I_w_WI;
17 
19  : Measurement("ImuMeasurement"), I_a_WI{0, 0, 0}, I_w_WI{0, 0, 0} {}
20 
21  ~ImuMeasurement() override {}
22 
23  friend std::ostream& operator<<(std::ostream& stream,
24  const ImuMeasurement& meas);
25 };
26 
27 std::ostream& operator<<(std::ostream& stream, const ImuMeasurement& meas) {
28  stream << "IMU Measurement at time = " << meas.time << " : \n"
29  << "dt : " << meas.dt << "\n"
30  << "I_a_WI: " << meas.I_a_WI.transpose() << "\n"
31  << "I_w_WI: " << meas.I_w_WI.transpose() << "\n";
32  return stream;
33 }
34 
35 } // namespace gtsam
gtsam::ImuMeasurement::RH_FOOT
@ RH_FOOT
Definition: ImuMeasurement.h:12
gtsam::ImuMeasurement::RF_FOOT
@ RF_FOOT
Definition: ImuMeasurement.h:12
gtsam::operator<<
std::ostream & operator<<(std::ostream &os, const Dih6 &m)
Definition: testGroup.cpp:109
gtsam.examples.SFMExample_bal.stream
stream
Definition: SFMExample_bal.py:24
gtsam::ImuMeasurement::BODY
@ BODY
Definition: ImuMeasurement.h:12
gtsam::Measurement::time
size_t time
The type of message (to enable dynamic/static casting).
Definition: Measurement.h:15
gtsam::ImuMeasurement::~ImuMeasurement
~ImuMeasurement() override
Definition: ImuMeasurement.h:21
gtsam::Measurement
This is the base class for all measurement types.
Definition: Measurement.h:11
gtsam::ImuMeasurement::operator<<
friend std::ostream & operator<<(std::ostream &stream, const ImuMeasurement &meas)
Definition: ImuMeasurement.h:27
gtsam::ImuMeasurement::Name
Name
Definition: ImuMeasurement.h:12
Measurement.h
gtsam::Measurement::dt
EIGEN_MAKE_ALIGNED_OPERATOR_NEW size_t dt
Time since the last message of this type (nanoseconds).
Definition: Measurement.h:14
gtsam::ImuMeasurement
Contains data from the IMU mesaurements.
Definition: ImuMeasurement.h:10
gtsam::ImuMeasurement::I_w_WI
Eigen::Vector3d I_w_WI
Raw angular velocity from the IMU (rad/s)
Definition: ImuMeasurement.h:16
gtsam
traits
Definition: SFMdata.h:40
gtsam::ImuMeasurement::name
Name name
Unique string identifier.
Definition: ImuMeasurement.h:14
gtsam::ImuMeasurement::I_a_WI
Eigen::Vector3d I_a_WI
Raw acceleration from the IMU (m/s/s)
Definition: ImuMeasurement.h:15
gtsam::ImuMeasurement::ImuMeasurement
ImuMeasurement()
Definition: ImuMeasurement.h:18


gtsam
Author(s):
autogenerated on Sat Nov 16 2024 04:02:27