SE-Sync: A certifiably correct algorithm for synchronization over the special Euclidean group (The International journal of robotics research)