This invention relates to a multi-
sensor fusion localization and mapping method and
system based on single-anchor-point extrinsic constraints, belonging to the field of robotic multi-
sensor fusion SLAM technology. It aims to solve problems such as poor scale and heading
observability in degraded environments, strong susceptibility of UWB to non-line-of-
sight interference, and easy drift during optimization when using single-anchor-point UWB /
LiDAR / IMU fusion. The invention constructs a joint optimization vector and a sliding window
factor graph, assesses
ranging reliability through geometric
visibility and channel quality, and adaptively incorporates UWB factors. It utilizes the eigenvalues of the information matrix to evaluate
observability, and employs compensation strategies such as
ranging filtering and
weight adjustment during degradation. The output
pose is iteratively optimized and stitched together to generate a 3D map. The
system includes modules for
data synchronization, reliability assessment,
factor graph optimization, degradation compensation, and mapping output. This invention achieves stable localization and mapping with only a single
anchor point, suppresses drift and
divergence, is suitable for complex scenarios where GNSS fails, and features low deployment cost, strong adaptability, and high accuracy.