A Benchmark Survey of Rigid 3D Point Cloud Registration Algorithms