https://123dok.net/document/yev9meez-global-point-to-hyperplane-icp-local-and-global-pose-estimation-by-fusing-color-and-depth.html