Applied registration for robotics: Methodology and tools for ICP-like algorithms