German Ros, J. Guerrero, Angel Sappa and Antonio Lopez. 2013. VSLAM pose initialization via Lie groups and Lie algebras optimization. _Proceedings of IEEE International Conference on Robotics and Automation_.5740–5747.