GCOP
1.0
|
#include <imumanifold.h>
Public Member Functions | |
void | Lift (Vector9d &v, const ImuState &xa, const ImuState &xb) |
void | Retract (ImuState &xb, const ImuState &xa, const Vector9d &v) |
void | dtau (Matrix9d &M, const Vector9d &v) |
void | Adtau (Matrix9d &M, const Vector9d &v) |
Static Public Member Functions | |
static ImuManifold & | Instance () |
void ImuManifold::Adtau | ( | Matrix9d & | M, |
const Vector9d & | v | ||
) |
References Instance().
void ImuManifold::dtau | ( | Matrix9d & | M, |
const Vector9d & | v | ||
) |
References Instance().
ImuManifold & ImuManifold::Instance | ( | ) | [static] |
void ImuManifold::Lift | ( | Vector9d & | v, |
const ImuState & | xa, | ||
const ImuState & | xb | ||
) |
References gcop::ImuState::ba, gcop::ImuState::bg, Instance(), and gcop::ImuState::R.
void ImuManifold::Retract | ( | ImuState & | xb, |
const ImuState & | xa, | ||
const Vector9d & | v | ||
) |
References gcop::ImuState::ba, gcop::ImuState::bg, Instance(), and gcop::ImuState::R.