Cheetah Software  1.0
CheaterOrientationEstimator< T > Class Template Reference

#include <OrientationEstimator.h>

+ Inheritance diagram for CheaterOrientationEstimator< T >:
+ Collaboration diagram for CheaterOrientationEstimator< T >:

Public Member Functions

virtual void run ()
 
virtual void setup ()
 
- Public Member Functions inherited from GenericEstimator< T >
void setData (StateEstimatorData< T > data)
 
virtual ~GenericEstimator ()=default
 

Additional Inherited Members

- Public Attributes inherited from GenericEstimator< T >
StateEstimatorData< T > _stateEstimatorData
 

Detailed Description

template<typename T>
class CheaterOrientationEstimator< T >

Definition at line 18 of file OrientationEstimator.h.

Member Function Documentation

template<typename T >
void CheaterOrientationEstimator< T >::run ( )
virtual

Implements GenericEstimator< T >.

Definition at line 16 of file OrientationEstimator.cpp.

References ori::quaternionToRotationMatrix(), and ori::quatToRPY().

16  {
17  this->_stateEstimatorData.result->orientation =
18  this->_stateEstimatorData.cheaterState->orientation.template cast<T>();
20  this->_stateEstimatorData.result->orientation);
21  this->_stateEstimatorData.result->omegaBody =
22  this->_stateEstimatorData.cheaterState->omegaBody.template cast<T>();
23  this->_stateEstimatorData.result->omegaWorld =
24  this->_stateEstimatorData.result->rBody.transpose() *
25  this->_stateEstimatorData.result->omegaBody;
26  this->_stateEstimatorData.result->rpy =
27  ori::quatToRPY(this->_stateEstimatorData.result->orientation);
28  this->_stateEstimatorData.result->aBody =
29  this->_stateEstimatorData.cheaterState->acceleration.template cast<T>();
30  this->_stateEstimatorData.result->aWorld =
31  this->_stateEstimatorData.result->rBody.transpose() *
32  this->_stateEstimatorData.result->aBody;
33 }
Vec3< typename T::Scalar > quatToRPY(const Eigen::MatrixBase< T > &q)
Mat3< typename T::Scalar > quaternionToRotationMatrix(const Eigen::MatrixBase< T > &q)
StateEstimatorData< T > _stateEstimatorData

+ Here is the call graph for this function:

template<typename T >
virtual void CheaterOrientationEstimator< T >::setup ( )
inlinevirtual

Implements GenericEstimator< T >.

Definition at line 21 of file OrientationEstimator.h.

21 {}

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