The application provides a kind of robust
laser SLAM repositioning and mapping method for embodied intelligent
robot in the technical field of
robot autonomous navigation, comprising: receiving original
laser radar point cloud and IMU data, pre-
processing point cloud to extract feature points;IMU pre-integration provides initial
pose constraint;
Loop closure detection is through the two-stage
cascade of ScanContext global search and LinK3D
local matching, obtains repositioning constraint;Front-end
odometry matches feature points with local
voxel map, combines IMU optimization to output
pose estimation, filters
key frame to generate
laser odometry factor;With repositioning constraint as initial value, use improved ICP to accurately register to obtain repositioning factor;Finally, construct
factor graph, jointly optimize IMU, laser
odometry and repositioning factor, solve global consistent
pose sequence and map.The application has the advantages that: it greatly improves the
system robustness, repositioning accuracy and
global map consistency of quadruped
robot in severe motion and large-scale scene, while meeting the real-time constraint of embedded platform.