In order to further improve the matching accuracy, the Gauss Newton method is used to optimize the results. Due to the high accuracy of 2D lidar, only 2D point cloud is considered in optimization. Therefore, the objective function is as follows:
正在翻译中..