stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem Class Reference

This class describes the dynamics of a robot's flexibility this dynamics is the simplest possible system, the flexibility is expressed as a rotation against the contact positions with no other hypothesis than that the contact points are at constant position. More...

#include <state-observation/flexibility-estimation/stable-imu-fixed-contact-dynamical-system.hpp>

Inheritance diagram for stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem:
Collaboration diagram for stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem:

Public Member Functions

 StableIMUFixedContactDynamicalSystem (double dt)
 constructor More...
 
virtual ~StableIMUFixedContactDynamicalSystem ()
 virtual destructor More...
 
virtual Vector3 stabilizeAccelerationLinear (Vector3, Vector3)
 
virtual Vector3 stabilizeAccelerationAngular (Vector3, Vector3)
 
virtual stateObservation::Vector stateDynamics (const stateObservation::Vector &x, const stateObservation::Vector &u, TimeIndex k)
 Description of the state dynamics. More...
 
virtual stateObservation::Vector measureDynamics (const stateObservation::Vector &x, const stateObservation::Vector &u, TimeIndex k)
 Description of the sensor's dynamics. More...
 
virtual void setProcessNoise (stateObservation::NoiseBase *)
 Sets a noise which disturbs the state dynamics. More...
 
virtual void resetProcessNoise ()
 Removes the process noise. More...
 
virtual stateObservation::NoiseBasegetProcessNoise () const
 Gets the process noise. More...
 
virtual void setMeasurementNoise (stateObservation::NoiseBase *)
 Sets a noise which disturbs the measurements. More...
 
virtual void resetMeasurementNoise ()
 Removes the measurement noise. More...
 
virtual stateObservation::NoiseBasegetMeasurementNoise () const
 Gets a pointer on the measurement noise. More...
 
virtual void setSamplingPeriod (double dt)
 Set the period of the time discretization. More...
 
virtual Index getStateSize () const
 Gets the state size. More...
 
virtual Index getInputSize () const
 Gets the input size. More...
 
virtual Index getMeasurementSize () const
 Gets the measurement size. More...
 
virtual void setContactsNumber (unsigned)
 Sets the number of contacts. More...
 
virtual void setContactPosition (unsigned i, const Vector3 &position)
 Sets the position of the contact number i. More...
 
- Public Member Functions inherited from stateObservation::DynamicalSystemFunctorBase
 DynamicalSystemFunctorBase ()
 
virtual ~DynamicalSystemFunctorBase ()
 
virtual void reset ()
 
virtual bool checkStateVector (const Vector &)
 Gives a boolean answer on whether or not the vector is correctly sized to be a state vector. More...
 
virtual bool checkInputvector (const Vector &)
 Gives a boolean answer on whether or not the vector is correctly sized to be an input vector. More...
 

Protected Types

typedef kine::indexes< kine::rotationVectorindexes
 

Protected Member Functions

Quaternion computeQuaternion_ (const Vector3 &x)
 
- Protected Member Functions inherited from stateObservation::DynamicalSystemFunctorBase
void assertStateVector_ (const Vector &v)
 
void assertInputVector_ (const Vector &v)
 

Protected Attributes

stateObservation::AccelerometerGyrometer sensor_
 
stateObservation::NoiseBaseprocessNoise_
 
double dt_
 
Vector3Unaligned orientationVector_
 
QuaternionUnaligned quaternion_
 
Index measurementSize_
 
std::vector< Vector3, Eigen::aligned_allocator< Vector3 > > contactPositions_
 

Static Protected Attributes

static const Index stateSize_ = 18
 
static const Index inputSize_ = 15
 
static const Index measurementSizeBase_ = 6
 

Detailed Description

This class describes the dynamics of a robot's flexibility this dynamics is the simplest possible system, the flexibility is expressed as a rotation against the contact positions with no other hypothesis than that the contact points are at constant position.

Member Typedef Documentation

◆ indexes

Constructor & Destructor Documentation

◆ StableIMUFixedContactDynamicalSystem()

stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::StableIMUFixedContactDynamicalSystem ( double  dt)
explicit

constructor

◆ ~StableIMUFixedContactDynamicalSystem()

virtual stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::~StableIMUFixedContactDynamicalSystem ( )
virtual

virtual destructor

Member Function Documentation

◆ computeQuaternion_()

Quaternion stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::computeQuaternion_ ( const Vector3 x)
protected

◆ getInputSize()

virtual Index stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::getInputSize ( ) const
virtual

Gets the input size.

Implements stateObservation::DynamicalSystemFunctorBase.

◆ getMeasurementNoise()

virtual stateObservation::NoiseBase* stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::getMeasurementNoise ( ) const
virtual

Gets a pointer on the measurement noise.

◆ getMeasurementSize()

virtual Index stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::getMeasurementSize ( ) const
virtual

Gets the measurement size.

Implements stateObservation::DynamicalSystemFunctorBase.

◆ getProcessNoise()

virtual stateObservation::NoiseBase* stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::getProcessNoise ( ) const
virtual

Gets the process noise.

◆ getStateSize()

virtual Index stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::getStateSize ( ) const
virtual

Gets the state size.

Implements stateObservation::DynamicalSystemFunctorBase.

◆ measureDynamics()

virtual stateObservation::Vector stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::measureDynamics ( const stateObservation::Vector x,
const stateObservation::Vector u,
TimeIndex  k 
)
virtual

Description of the sensor's dynamics.

Implements stateObservation::DynamicalSystemFunctorBase.

◆ resetMeasurementNoise()

virtual void stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::resetMeasurementNoise ( )
virtual

Removes the measurement noise.

◆ resetProcessNoise()

virtual void stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::resetProcessNoise ( )
virtual

Removes the process noise.

◆ setContactPosition()

virtual void stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::setContactPosition ( unsigned  i,
const Vector3 position 
)
virtual

Sets the position of the contact number i.

◆ setContactsNumber()

virtual void stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::setContactsNumber ( unsigned  )
virtual

Sets the number of contacts.

◆ setMeasurementNoise()

virtual void stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::setMeasurementNoise ( stateObservation::NoiseBase )
virtual

Sets a noise which disturbs the measurements.

◆ setProcessNoise()

virtual void stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::setProcessNoise ( stateObservation::NoiseBase )
virtual

Sets a noise which disturbs the state dynamics.

◆ setSamplingPeriod()

virtual void stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::setSamplingPeriod ( double  dt)
virtual

Set the period of the time discretization.

◆ stabilizeAccelerationAngular()

virtual Vector3 stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::stabilizeAccelerationAngular ( Vector3  ,
Vector3   
)
virtual

◆ stabilizeAccelerationLinear()

virtual Vector3 stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::stabilizeAccelerationLinear ( Vector3  ,
Vector3   
)
virtual

◆ stateDynamics()

virtual stateObservation::Vector stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::stateDynamics ( const stateObservation::Vector x,
const stateObservation::Vector u,
TimeIndex  k 
)
virtual

Description of the state dynamics.

Implements stateObservation::DynamicalSystemFunctorBase.

Member Data Documentation

◆ contactPositions_

std::vector<Vector3, Eigen::aligned_allocator<Vector3> > stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::contactPositions_
protected

◆ dt_

double stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::dt_
protected

◆ inputSize_

const Index stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::inputSize_ = 15
staticprotected

◆ measurementSize_

Index stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::measurementSize_
protected

◆ measurementSizeBase_

const Index stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::measurementSizeBase_ = 6
staticprotected

◆ orientationVector_

Vector3Unaligned stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::orientationVector_
protected

◆ processNoise_

stateObservation::NoiseBase* stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::processNoise_
protected

◆ quaternion_

QuaternionUnaligned stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::quaternion_
protected

◆ sensor_

stateObservation::AccelerometerGyrometer stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::sensor_
protected

◆ stateSize_

const Index stateObservation::flexibilityEstimation::StableIMUFixedContactDynamicalSystem::stateSize_ = 18
staticprotected

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