Dynamic target positioning method
The invention discloses a dynamic target positioning method, which comprises the following steps of: acquiring data in real time by using an inertial measurement unit and an ultra wide band module, and repeating the following steps in the process: initializing state estimation and an error covarianc...
Saved in:
Main Authors | , , , , |
---|---|
Format | Patent |
Language | Chinese English |
Published |
29.11.2022
|
Subjects | |
Online Access | Get full text |
Cover
Loading…
Summary: | The invention discloses a dynamic target positioning method, which comprises the following steps of: acquiring data in real time by using an inertial measurement unit and an ultra wide band module, and repeating the following steps in the process: initializing state estimation and an error covariance matrix by using the data acquired at the current moment; carrying out SVD decomposition on the error covariance matrix to calculate volume points; evaluating the volume points through a nonlinear state model to obtain propagated volume points; the prediction state and the error covariance are updated using the volume points. Based on the updated prediction state and the error covariance, a first Kalman filter is adopted to carry out prediction quantity updating and Kalman gain calculation, and a second Kalman filter is adopted to update the state estimation and the error covariance matrix. And fusing local estimation information of the two Kalman filters by adopting a federated filtering framework, and updating s |
---|---|
Bibliography: | Application Number: CN202211005507 |