Finally, the dot cloud data is inserted into the submap, the lidar data is re-projected, the least squares problem is constructed, and the matching accuracy is further improved by optimization. After the matching is complete, the current laser point and RGB-D camera point are inserted into the submap, and when the number of frames reaches a certain size, save as a key frame for subsequent loopback detection, while the new key frame is established.
正在翻译中..