Motion estimation of rigid targets based on an adaptive unscented kalman filter on lie groups
摘要
This study proposes a method for estimating the position and attitude of targets based on multi-sensor nonlinear measurement systems (MSNMS). We first establish an integrated model coupling translational and rotational dynamics, alongside a measurement model incorporating distance and radial velocity. The necessary and sufficient conditions for system observability are rigorously derived. Analysis reveals that conventional filtering methods suffer from linearization errors and state-representation mismatch, and we further prove that such external measurement systems are not group affine, rendering invariant observer frameworks inapplicable. To overcome these limitations, the unscented Kalman filter on Lie groups (UKF-LG) within the framework of MSNMS is developed. An adaptive update method for the state and measurement noise covariance matrices is designed, leading to the proposed adaptive UKF-LG. This method effectively enhances estimation accuracy and robustness against complex environments and inaccurate prior noise statistics. Simulation experiments demonstrate the superior performance of the proposed method.