Lidar Odometry and Mapping with Mutiple Metrics Linear Least Square ICP - View it on GitHub