The invention discloses an ultra-
wideband laser radar inertial navigation cooperative SLAM (
Simultaneous Localization and Mapping) method and
system, which are suitable for
robot positioning and mapping tasks in a GPS (
Global Positioning System)-free environment. According to the method, high-frequency motion priori of an IMU, relative
pose constraint of
LiDAR and absolute
ranging information of UWB are fused, a unified
factor graph optimization model is constructed, and multi-sensor cooperative positioning is realized; in the
system initialization stage, IMU bias calibration, UWB
base station coordinate configuration and
LiDAR initial attitude
estimation are completed; in the operation process, IMU pre-integration is utilized to predict the
pose,
LiDAR point cloud registration is utilized to obtain the
relative motion between key frames, UWB
ranging is combined to construct a residual item, a self-adaptive weight mechanism is introduced to suppress
ranging abnormity, and the fusion robustness is improved; the
system supports geometric feature
loopback detection, cross-frame constraints are constructed in combination with UWB to carry out closed-
loop optimization, and an optimization result is used for real-time incremental updating of a
global map; the method has the advantages of high positioning precision, strong anti-interference capability, wide application scene and the like.