Giorgio Grisetti, Rainer Kümmerle, Cyrill Stachniss, Udo Frese, and Christoph Hertzberg Hierarchical Optimization on Manifolds for Online 2D and 3D Mapping. In Proc. of the IEEE International Conference on Robotics and Automation (ICRA), Anchorage, Alaska, 2010.