The invention discloses an indoor UWB-IMU fusion trajectory
tracking system and method based on
factor graph optimization, and belongs to the technical field of UWB indoor positioning. The
system adopts a multi-stage
processing framework, and specifically comprises the following steps: firstly, collecting channel
pulse response and distance information by virtue of a
wireless communication
system, constructing a dynamic environment sensing mechanism, and evaluating the
current channel state and the availability of each
base station in real time; secondly, for the
ranging values of the available base stations in the NLOS environment, compensating by using historical information, and for the
ranging values of the unavailable base stations, estimating and correcting by using a
time step length; and finally, collaborative optimization is carried out on UWB
ranging data, IMU inertial information and
base station state information through an SW-FGO
algorithm, so that positioning stability is ensured, and adverse effects of obstacle shielding and a
multipath effect on trajectory tracking precision are reduced. The invention provides a fusion
positioning system which combines the advantages of UWB and IMU, can realize the tracking of a target motion track, and is suitable for most LOS and NLOS indoor mixed scenes.