Lagrangian Duality in 3D SLAM: Verification Techniques and Optimal Solutions