A Branch-and-Prune Algorithm for Solving Systems of Distance Constraints