Measurement-driven Gauss-Hermite Particle Filter with Soft Spatiotemporal Constraints for Multi-Optical Theodolites Target Tracking

Multi-Optical Theodolite Tracking systems (MOTTs) can stealthily extract the target’s status information from bearings only through non-contact measurement. The constrained MOTTs are partially compatible, yet many existing research works and results are based on the known model, ignoring its discrimination with the target maneuvering behavior pattern. To compensate for these mismatches, this paper develops a Measurement-driven Gauss-Hermite Particle Filter (MGHPF), which elegantly fuses the spatiotemporal constraints and its soft form to perform MOTT missions. Specifically, the target dynamic model and tracking algorithm are based on the target behavior pattern with the adaptive turn rate, fully exploiting the spatial epipolar geometry characteristics for each intersection measurement by a minimax strategy. Then, the center of the feasible area is approximated via the analytic coordinate transformation, and the latent samples are updated via the deterministic Gauss-Hermite integral method with the target’s predictive turn rate. Simultaneously, the effects of truncation correction and compensation feedback from the current measurement and historical estimation data are adaptively incorporated into the PF’s importance distribution to cover the mixture likelihood. Besides, an effective causality-invariant updating rule is provided to estimate the parameters of these soft spatiotemporal constrained MOTTs with convergence guarantees. Simulated and measured results show good agreement; compared with the state-of-the-art Multi-Model Rao-Blackwell Particle Filter (MMRBPF), the proposed MGHPF improves the filtering accuracy by 7.4%-34.7% and significantly reduces the computational load.