GCOP
1.0
|
#include <insmanifold.h>
Public Member Functions | |
void | Lift (Vector15d &v, const InsState &xa, const InsState &xb) |
void | Retract (InsState &xb, const InsState &xa, const Vector15d &v) |
void | dtau (Matrix15d &M, const Vector15d &v) |
void | Adtau (Matrix15d &M, const Vector15d &v) |
Static Public Member Functions | |
static InsManifold & | Instance () |
void InsManifold::Adtau | ( | Matrix15d & | M, |
const Vector15d & | v | ||
) |
References Instance().
void InsManifold::dtau | ( | Matrix15d & | M, |
const Vector15d & | v | ||
) |
References Instance().
InsManifold & InsManifold::Instance | ( | ) | [static] |
void InsManifold::Lift | ( | Vector15d & | v, |
const InsState & | xa, | ||
const InsState & | xb | ||
) |
References gcop::InsState::ba, gcop::InsState::bg, Instance(), gcop::InsState::p, gcop::InsState::R, and gcop::InsState::v.
void InsManifold::Retract | ( | InsState & | xb, |
const InsState & | xa, | ||
const Vector15d & | v | ||
) |
References gcop::InsState::ba, gcop::InsState::bg, Instance(), gcop::InsState::p, gcop::InsState::R, and gcop::InsState::v.