Based on Benedict Brown's paper "Global Non-Rigid Alignment of 3D Laser Scans"