imumodel
Public Member Functions | Static Public Attributes | Protected Types | Protected Member Functions | Protected Attributes | List of all members
imumodel::ImuError Class Reference

#include <ImuError.hpp>

Public Member Functions

void init ()
 
void reset ()
 
void step ()
 
void addNoise (base::samples::IMUSensors &imu_sample)
 
void setConfiguration (const Configuration &config)
 
const ConfigurationgetConfiguration () const
 
ConfigurationgetConfiguration ()
 
base::Vector3d getGyroError () const
 

Static Public Attributes

static const int NUMAXIS = 3
 

Protected Types

typedef boost::mt19937 RandomGenerator
 

Protected Member Functions

double GetNormalDistri (double mean, double sigma)
 

Protected Attributes

Configuration config
 
base::Vector2d xax
 
base::Vector2d xay
 
base::Vector2d xaz
 
base::Matrix2d Aax
 
base::Vector2d Gax
 
base::Matrix2d Aay
 
base::Vector2d Gay
 
base::Matrix2d Aaz
 
base::Vector2d Gaz
 
base::Vector2d Ha
 
base::Vector2d xgx
 
base::Vector2d xgy
 
base::Vector2d xgz
 
base::Matrix2d Agx
 
base::Vector2d Ggx
 
base::Matrix2d Agy
 
base::Vector2d Ggy
 
base::Matrix2d Agz
 
base::Vector2d Ggz
 
base::Vector2d Hg
 
Eigen::Matrix< double, NUMAXIS, 1 > acc
 
Eigen::Matrix< double, NUMAXIS, 1 > gyros
 
Eigen::Matrix< double, NUMAXIS, NUMAXISDacc
 
Eigen::Matrix< double, NUMAXIS, NUMAXISDgyro
 
RandomGenerator rng
 

Member Typedef Documentation

◆ RandomGenerator

typedef boost::mt19937 imumodel::ImuError::RandomGenerator
protected

Member Function Documentation

◆ addNoise()

void ImuError::addNoise ( base::samples::IMUSensors &  imu_sample)

Include the deterministic error to the model (accelerometer and gyroscopes)

◆ getConfiguration() [1/2]

const Configuration & ImuError::getConfiguration ( ) const

◆ getConfiguration() [2/2]

Configuration & ImuError::getConfiguration ( )

◆ getGyroError()

base::Vector3d ImuError::getGyroError ( ) const

◆ GetNormalDistri()

double ImuError::GetNormalDistri ( double  mean,
double  sigma 
)
protected

◆ init()

void ImuError::init ( )

Fill the matrices with the configure values for the accelerometer model X axis

Fill the matrices with the configure values for the accelerometer model Y axis

Fill the matrices with the configure values for the accelerometer model Z axis

Measurement matrix

Fill the matrices with the configure values for the gyroscope model X axis

Fill the matrices with the configure values for the gyroscope model Y axis

Fill the matrices with the configure values for the gyroscope model Z axis

Measurement matrix

deterministic matrices to zero

◆ reset()

void ImuError::reset ( )

Reset the state vectors and the output vectors

◆ setConfiguration()

void ImuError::setConfiguration ( const Configuration config)

◆ step()

void ImuError::step ( )

White noise for the Velocty Random Walk for accelerometers

Perform the model step for Accelerometers Xaxis

Perform the model step for Accelerometers Yaxis

Perform the model step for Accelerometers Zaxis

White noise for the Angular Random Walk for gyroscopes

Perform the model step for gyroscopes Xaxis

Perform the model step for gyroscopes Yaxis

Perform the model step for gyroscopes Zaxis

Member Data Documentation

◆ Aax

base::Matrix2d imumodel::ImuError::Aax
protected

State Matrix for Accelerometer x axis

◆ Aay

base::Matrix2d imumodel::ImuError::Aay
protected

State Matrix for Accelerometer y axis

◆ Aaz

base::Matrix2d imumodel::ImuError::Aaz
protected

State Matrix for Accelerometer z axis

◆ acc

Eigen::Matrix<double,NUMAXIS,1> imumodel::ImuError::acc
protected

◆ Agx

base::Matrix2d imumodel::ImuError::Agx
protected

State Matrix for Gyro x axis

◆ Agy

base::Matrix2d imumodel::ImuError::Agy
protected

State Matrix for Gyro y axis

◆ Agz

base::Matrix2d imumodel::ImuError::Agz
protected

State Matrix for Gyro z axis

◆ config

Configuration imumodel::ImuError::config
protected

◆ Dacc

Eigen::Matrix<double,NUMAXIS,NUMAXIS> imumodel::ImuError::Dacc
protected

◆ Dgyro

Eigen::Matrix<double,NUMAXIS,NUMAXIS> imumodel::ImuError::Dgyro
protected

Deterministics error matrices for acc and gyros

◆ Gax

base::Vector2d imumodel::ImuError::Gax
protected

Input Matrix for Accelerometer x axis

◆ Gay

base::Vector2d imumodel::ImuError::Gay
protected

Input Matrix for Accelerometer y axis

◆ Gaz

base::Vector2d imumodel::ImuError::Gaz
protected

Input Matrix for Accelerometer z axis

◆ Ggx

base::Vector2d imumodel::ImuError::Ggx
protected

Input Matrix for Gyro x axis

◆ Ggy

base::Vector2d imumodel::ImuError::Ggy
protected

Input Matrix for Gyro y axis

◆ Ggz

base::Vector2d imumodel::ImuError::Ggz
protected

Input Matrix for Gyro z axis

◆ gyros

Eigen::Matrix<double,NUMAXIS,1> imumodel::ImuError::gyros
protected

Accelerometer and gyroscopes output vectors

◆ Ha

base::Vector2d imumodel::ImuError::Ha
protected

Observation Matrix for Accelerometers

◆ Hg

base::Vector2d imumodel::ImuError::Hg
protected

Observation Matrix for Gyroscopes

◆ NUMAXIS

const int imumodel::ImuError::NUMAXIS = 3
static

◆ rng

RandomGenerator imumodel::ImuError::rng
protected

◆ xax

base::Vector2d imumodel::ImuError::xax
protected

State vector for acc x axis model

◆ xay

base::Vector2d imumodel::ImuError::xay
protected

State vector for acc y axis model

◆ xaz

base::Vector2d imumodel::ImuError::xaz
protected

State vector for acc z axis model

◆ xgx

base::Vector2d imumodel::ImuError::xgx
protected

State vector for gyro x axis model

◆ xgy

base::Vector2d imumodel::ImuError::xgy
protected

State vector for gyro y axis model

◆ xgz

base::Vector2d imumodel::ImuError::xgz
protected

State vector for gyro z axis model


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