|
gtsam
|
Implements the lift Λ(ξ,u) from the paper: Λ encodes the lifted dynamics on G induced by the biased gyroscope input u = (ω,0).
Functor computing the lifted tangent vector from a state and fixed input. In the notation of Fornasier et al., this corresponds to Eq. (7), written in the so(3)≃ℝ³ identification.
Public Member Functions | |
| Lift (const Vector6 &u) | |
| G::TangentVector | operator() (const M &xi, OptionalJacobian< G::dimension, M::dimension > H={}) const |
Public Types | |
| using | M = State<N> |
| using | G = Group<N> |