KCP
An efficient and effective 3D laser scan matching