The invention relates to the technical field of
laser radar data processing, in particular to a
laser radar SLAM multi-loop detection and iterative optimization method and
electronic equipment. The method comprises the following steps: S1, designing a multi-loop
route of an unmanned aerial vehicle / vehicle
system, and extracting and storing loop detection point coordinates; s2, the unmanned aerial vehicle / vehicle
system travels according to the
route designed in the S1, extracts feature points of a current frame, calculates a global
pose, selects a
key frame and stores
point cloud and the
pose of the
key frame; s3, the unmanned aerial vehicle / vehicle
system enters a specified
radius of the coordinates of the detection point extracted in the S1 to carry out
loopback detection, and a current frame and a
key frame of the detection point are matched and selected; s4, solving a relative
pose change relationship between the current frame of the detection point selected in the S3 and the key frame
point cloud set, and globally optimizing all key frame poses and point clouds thereof in the loop; and S5, repeating the steps S3-S4 for iterative
loopback detection and
global optimization of the detection points one by one, and iteratively outputting the three-dimensional
point cloud applying optimization precision. According to the method, an unmanned aerial vehicle / vehicle system multi-loop
route and loop detection points are designed, an ICP iteration
nearest point and GTSAM
graph optimization method is applied, key frames in the route are selected, the detection points are matched with the current frame and the key frames one by one, the poses of all the key frames in the loop are iteratively optimized, and a three-dimensional point cloud applying optimization precision is iteratively output. Therefore, emergency and rapid
situation awareness with higher precision and
time efficiency can be realized.