A Generalization of the ICP Algorithm for Articulated Bodies.