|
gtsam
|
Minimal state manifold for the biased attitude system: ΞΎ = (R, b, S).
Template parameter N is the number of calibrated sensors.
Public Member Functions | |
| State (const Rot3 &R=Rot3(), const Vector3 &b=Z_3x1, const Calibrations< N > &S=Calibrations< N >()) | |
| Constructor. | |
| TangentVector | localCoordinates (const State< N > &other) const |
| Compute Local coordinates in the state relative to another state. | |
| State | retract (const TangentVector &v) const |
| Retract from tangent space back to the manifold. | |
| void | print (const std::string &s="") const |
| bool | equals (const State< N > &other, double tol=1e-9) const |
Static Public Member Functions | |
| static State | identity () |
| Identity function. | |
Public Attributes | |
| Rot3 | R |
| Vector3 | b |
| Calibrations< N > | S |
Static Public Attributes | |
| static constexpr int | dimension = 6 + 3 * static_cast<int>(N) |
Public Types | |
| using | TangentVector = Eigen::Matrix<double, dimension, 1> |
|
inline |
Compute Local coordinates in the state relative to another state.
| other | The other state |
|
inline |
Retract from tangent space back to the manifold.
| v | Vector in the tangent space |