Initialization of 3D pose graph optimization using Lagrangian duality | Publicación