Reversible Kalman Filter for state estimation with Manifold

Open in new window