The invention discloses a
LiDAR-IMU-camera tight
coupling positioning and mapping method and device for a mobile platform, and belongs to the technical field of
robot SLAM. Synchronously triggering the color camera, the
laser radar and the IMU through hardware, and unifying timestamps; performing compensation and
distortion removal on the
laser point cloud motion by the IMU data; based on curvature, intensity and density self-adaptive downsampling, local
plane fitting errors are used for distributing observation weights; the IMU pre-integration
pose is used as an initial value, point-to-surface registration of the weighted
point cloud and the
local map is carried out, and a
laser-IMU tight
coupling odometer factor is obtained; the
color image and the
laser intensity graph are fused into a multi-mode
loopback descriptor, and
loopback factors are generated through global retrieval and geometric
verification; and inputting an
odometer, an IMU, a laser
loopback factor and a visual loopback factor into an increment
factor graph optimizer, jointly solving a
global optimal key frame pose, and outputting a dense laser
point cloud map and a color visual point cloud map. The method can be operated in real time on an embedded platform, effectively inhibits drifting, and realizes
centimeter-level global consistent positioning and mapping.