Add ukf-manifold estimator for constant curvature

- add operations for so2
- add operations for se3 and follow numpy sinc implementation for
calculating 1-cos x / x since top converges to zero faster
- add ukf-manifold algorithm
- add drawing for variance error ellipses
- add ukf-manifold estimator to constant curvature example