Distributed Estimation for a 3-D Moving Target in Quaternion Space with Unknown Correlation (2405.05848v1)
Abstract: For distributed estimations in a sensor network, the consistency and accuracy of an estimator are greatly affected by the unknown correlations between individual estimates. An inconsistent or too conservative estimate may degrade the estimation performance and even cause divergence of the estimator. Cooperative estimation methods based on Inverse Covariance Intersection (ICI) can utilize a network of sensors to provide a consistent and tight estimate of a target. In this paper, unlike most existing ICI-based estimators that only consider two-dimensional (2-D) target state estimation in the vector space, we address this problem in a 3-D environment by extending the ICI algorithm to the augmented quaternion space. In addition, the proposed algorithm is fully distributed, as each agent only uses the local information from itself and its communication neighbors, which is also robust to a time-varying communication topology. To evaluate the performance, we test the proposed algorithm in a camera network to track the pose of a target. Extensive Monte Carlo simulations have been performed to show the effectiveness of our approach.
- P. Zhu and W. Ren, “Fully distributed joint localization and target tracking with mobile robot networks,” IEEE Transactions on Control Systems Technology, vol. 29, no. 4, pp. 1519–1532, 2021.
- Y. Zhou, C. Nowzari, and X. Wang, “Distributed multi-robot flocking based on acoustic doppler effect,” in 2023 62nd IEEE Conference on Decision and Control (CDC), 2023, pp. 6406–6411.
- Y. Wei, Z. Wei, Y. Rao, J. Li, J. Zhou, and J. Lu, “Lidar distillation: Bridging the beam-induced domain gap for 3d object detection,” in Computer Vision – ECCV 2022, S. Avidan, G. Brostow, M. Cissé, G. M. Farinella, and T. Hassner, Eds. Cham: Springer Nature Switzerland, 2022, pp. 179–195.
- X. Wang, S. Wang, and D. Bi, “Distributed visual-target-surveillance system in wireless sensor networks,” IEEE Transactions on Systems, Man, and Cybernetics, Part B (Cybernetics), vol. 39, no. 5, pp. 1134–1146, 2009.
- M. Liggins, C.-Y. Chong, I. Kadar, M. Alford, V. Vannicola, and S. Thomopoulos, “Distributed fusion architectures and algorithms for target tracking,” Proceedings of the IEEE, vol. 85, no. 1, pp. 95–107, 1997.
- N. Trawny and S. I. Roumeliotis, “Indirect Kalman filter for 3d attitude estimation,” University of Minnesota, Dept. of Comp. Sci. & Eng., Tech. Rep, vol. 2, p. 2005, 2005.
- O. Hlinka, O. Slučiak, F. Hlawatsch, and M. Rupp, “Distributed data fusion using iterative covariance intersection,” in 2014 IEEE International Conference on Acoustics, Speech and Signal Processing (ICASSP), 2014, pp. 1861–1865.
- J. Xu, P. Zhu, Y. Zhou, and W. Ren, “Distributed invariant extended kalman filter using lie groups: Algorithm and experiments,” IEEE Transactions on Control Systems Technology, vol. 31, no. 6, pp. 2777–2789, 2023.
- P. Arambel, C. Rago, and R. Mehra, “Covariance intersection algorithm for distributed spacecraft state estimation,” in Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148), vol. 6, 2001, pp. 4398–4403 vol.6.
- P. Zhu and W. Ren, “Distributed kalman filter for 3-d moving object tracking over sensor networks,” in 2020 59th IEEE Conference on Decision and Control (CDC), 2020, pp. 2418–2423.
- L. Chen, P. Arambel, and R. Mehra, “Fusion under unknown correlation - covariance intersection as a special case,” in Proceedings of the Fifth International Conference on Information Fusion. FUSION 2002. (IEEE Cat.No.02EX5997), vol. 2, 2002, pp. 905–912 vol.2.
- M. Reinhardt, B. Noack, P. O. Arambel, and U. D. Hanebeck, “Minimum covariance bounds for the fusion under unknown correlations,” IEEE Signal Processing Letters, vol. 22, no. 9, pp. 1210–1214, 2015.
- B. Noack, J. Sijs, M. Reinhardt, and U. D. Hanebeck, “Decentralized data fusion with inverse covariance intersection,” Automatica, vol. 79, pp. 35–41, 2017. [Online]. Available: https://www.sciencedirect.com/science/article/pii/S0005109817300298
- J. Ajgl and O. Straka, “Inverse covariance intersection fusion of multiple estimates,” in 2020 IEEE 23rd International Conference on Information Fusion (FUSION), 2020, pp. 1–8.
- B. Noack, U. Orguner, and U. D. Hanebeck, “Nonlinear decentralized data fusion with generalized inverse covariance intersection,” in 2019 22th International Conference on Information Fusion (FUSION), 2019, pp. 1–7.
- T. Sun and M. Xin, “Inverse-covariance-intersection-based distributed estimation and application in wireless sensor network,” IEEE Transactions on Industrial Informatics, vol. 19, no. 10, pp. 10 079–10 090, 2023.
- S. Tao and X. Ming, “Distributed estimation with iterative inverse covariance intersection,” vol. 70, no. 4, 2023, pp. 1645–1649.
- L. Qi, X. Wang, and C. Cui, “Augmented quaternion and augmented unit quaternion optimization,” 2023. [Online]. Available: https://api.semanticscholar.org/CorpusID:257219095
- S. Julier and J. Uhlmann, “A non-divergent estimation algorithm in the presence of unknown correlations,” in Proceedings of the 1997 American Control Conference (Cat. No.97CH36041), vol. 4, 1997, pp. 2369–2373 vol.4.
- C. K. N. John L. Crassidis, Yang Cheng and A. M. Fosbury, “Decentralized attitude estimation using a quaternion covariance intersection approach,” The Journal of the Astronautical Sciences, vol. 11, pp. 113–128, 2009.
- G. P. Huang, A. I. Mourikis, and S. I. Roumeliotis, “An observability-constrained sliding window filter for slam,” in 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2011, pp. 65–72.