developing a robust disaster response robot : chimp and the robotics challenge .
A method for registration of 3d shapes