in the form, a represents the position of the submap, b represents the position of the laser frame, and the loop backbound constraint seamount between the laser frame detected during the map construction is represented by the relative position c between them and the corresponding covariance matrix d. p is a loss function whose primary function is to reduce the impact of error constraints when optimizing, and the Huber loss function can be used. Residual e is calculated by formula (5-13).
正在翻译中..