The invention discloses a degradation scene-oriented multi-residual fusion
laser radar positioning method, which comprises the following steps of: firstly, performing
state prediction by adopting an iterative extended Kalman filtering framework and an IMU (
Inertial Measurement Unit), and constructing three complementary observation models of a
global map matching residual, a local point-to-plane geometry residual and a
luminosity residual; secondly, designing a degradation sensing
mechanism based on a
covariance ellipsoid, representing absolute and relative degradation degrees through a
condition number and an information entropy respectively, realizing quantitative evaluation of
system observability, and dynamically adjusting fusion weights of observation residuals; meanwhile, a self-adaptive weight strategy based on
luminosity Jacobi intensity is introduced; and finally, performing
anomaly detection through deviation comparison between the IMU predicted
pose and the IEKF estimated
pose, inhibiting
pose jump, and ensuring continuity of a positioning
time sequence. The method effectively overcomes the challenges of geometric constraint deficiency, positioning drift accumulation and the like of the
LiDAR positioning system in the geometric degradation environment, does not need to adjust parameters for a specific scene, and improves the precision, robustness and real-time performance of global positioning in the degradation environment.