Integrating generic sensor fusion algorithms with sound state representations through encapsulation of manifolds.