The embodiment of the invention discloses a multi-
sensor fusion anti-degradation SLAM mapping method and
system. The method can effectively solve the problem of
pose drift of a
robot in a mapping process in structure degradation environments such as an indoor long corridor, constructs a globally consistent three-dimensional
point cloud map and a
robot trajectory, and comprises the following steps: realizing depth
coupling of an IMU and a wheel
speedometer based on extended Kalman filtering, and generating high-frequency
pose prediction; denoising, down-sampling and motion
distortion correction are carried out on the 4D
laser radar point cloud, and the normal vector and intensity characteristics of the
point cloud are extracted; a normal vector and intensity feature enhanced scanning matching
algorithm is adopted, and a target function is optimized through a multi-feature weight, so that the matching precision in a degradation scene is improved;
loopback detection is realized through
candidate key frame screening and geometric registration
verification, and a closed-loop constraint is incorporated into a
factor graph for global correction; and finally, incrementally updating the global point cloud map and carrying out consistency optimization, and outputting a robust three-dimensional point cloud map and a high-precision
robot track.