VSLAM pose initialization via Lie groups and Lie algebras optimization
Optimization algorithms on matrix manifolds