A Multi-Resolution Scheme ICP Algorithm for Fast Shape Registration