Abstract
This paper studies the distributed state estimation problem for a class of discrete-time linear time-varying systems over a bearings-only sensor network. A novel fusion estimation algorithm of the distance between the target and each sensor is constructed with the mean square error matrix of corresponding estimation being timely provided. Then, the refined estimation of distance is presented by minimizing the mean square error matrix. Furthermore, the distributed Kalman filter based state estimation algorithm is proposed based on the refined distance estimation. It is rigorously proven that the proposed method has the consistency and stability. Finally, numerical simulation results show the effectiveness of our methods.
Similar content being viewed by others
References
Zhang Y, Tian Y P. Consensus tracking in sensor networks with periodic sensing and switching connected topologies. Syst Control Lett, 2015, 84: 44–51
He Q B, Chen F Y, Cai S M, et al. An efficient range-free localization algorithm for wireless sensor networks. Sci China Tech Sci, 2011, 54: 1053–1060
Li C H, Zou H G, Shi D W, et al. Dual-quaternion-based satellite pose estimation and control with event-triggered data transmission. Sci China Tech Sci, 2023, 66: 1214–1224
Yick J, Mukherjee B, Ghosal D. Wireless sensor network survey. Comput Networks, 2008, 52: 2292–2330
Ren X, Wu J, Johansson K H, et al. Infinite horizon optimal transmission power control for remote state estimation over fading channels. IEEE Trans Automat Contr, 2017, 63: 85–100
Pei Y Q, Gu H B, Liu K X, et al. An overview on the designs of distributed observers in LTI multi-agent systems. Sci China Tech Sci, 2021, 64: 2337–2346
Li W, Wang Z, Wei G, et al. A survey on multisensor fusion and consensus filtering for sensor networks. Discrete Dyn Nat Soc, 2015, 1–12
Huang Z, Chen S, Hao C, et al. Bearings-only target tracking with an unbiased pseudo-linear Kalman filter. Remote Sens, 2021, 13: 2915
Li J R, Li H Y, Tang G J, et al. Research on the strategy of angles-only relative navigation for autonomous rendezvous. Sci China Tech Sci, 2011, 54: 1865–1872
Arun A, Ayyalasomayajula R, Hunter W, et al. P2SLAM: Bearing based WiFi SLAM for indoor robots. IEEE Robot Autom Lett, 2022, 7: 3326–3333
Gong Z Y, Qiu C R, Tao B, et al. Tracking and gras** of moving target based on accelerated geometric particle filter on colored image. Sci China Tech Sci, 2021, 64: 755–766
Woffinden D C, Geller D K. Observability criteria for angles-only navigation. IEEE Trans Aerosp Electron Syst, 2009, 45: 1194–1208
Martinelli A, Siegwart R. Observability analysis for mobile robot localization. In: Proceedings of the 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems. Edmonton: IEEE, 2005. 1471–1476
Han X, Liu M, Zhang S, et al. A multi-node cooperative bearing-only target passive tracking algorithm via UWSNs. IEEE Sens J, 2019, 19: 10609–10623
Nguyen N H, Dogancay K. Improved pseudolinear Kalman filter algorithms for bearings-only target tracking. IEEE Trans Signal Process, 2017, 65: 6119–6134
Asfia U, Radhakrishnan R, Sharma S N. Three-dimensional bearings-only target tracking: Comparison of few sigma point Kalman filters. In: Communication and Control for Robotic Systems. Singapore: Springer, 2022. 273–289
Badriasl L, Dogancay K. Three-dimensional target motion analysis using azimuth/elevation angles. IEEE Trans Aerosp Electron Syst, 2014, 50: 3178–3194
Nardone S C, Aidala V J. Observability criteria for bearings-only target motion analysis. IEEE Trans Aerospace Electro Syst, 1981, 17: 162–166
Bicchi A, Prattichizzo D, Marigo A, et al. On the observability of mobile vehicle localization. In: Theory and Practice of Control and Systems. Singapore: World Scientific, 1998. 142–147
Ma L, Hovakimyan N. Vision-based cyclic pursuit for cooperative target tracking. J Guid Control Dyn, 2013, 36: 617–622
Xu S, Doğançay K, Hmam H. Distributed pseudolinear estimation and UAV path optimization for 3D AOA target tracking. Signal Process, 2017, 133: 64–78
Zhang Q, **e Y, Song T L. Distributed multi-target tracking in clutter for passive linear array sonar systems. In: Proceedings of the 2017 20th International Conference on Information Fusion (Fusion). **’an: IEEE, 2017. 1–8
Zhong W, Luo X, Li X, et al. Lower bound accuracy of bearing-based localization for wireless sensor networks. IEEE Trans Signal Inf Process over Networks, 2020, 6: 556–569
Luo X, Zhong W, Li X, et al. Bearing rigidity-based localizability analysis for wireless sensor networks. IEEE Trans Signal Inf Process over Networks, 2020, 6: 526–539
Diao J, Guo J, Sun C. Vision-based target localization: A distributed convex optimization approach. In: Proceedings of the 2017 36th Chinese Control Conference (CCC). Dalian: IEEE, 2017. 8999–9004
Mohammadi A, Asif A. Distributed consensus + innovation particle filtering for bearing/range tracking with communication constraints. IEEE Trans Signal Process, 2014, 63: 620–635
Huang S, Dissanayake G. Convergence and consistency analysis for extended Kalman filter based SLAM. IEEE Trans Robot, 2007, 23: 1036–1049
Wang S, Ren W. On the convergence conditions of distributed dynamic state estimation using sensor networks: A unified framework. IEEE Trans Contr Syst Technol, 2017, 26: 1300–1316
Hu J, **e L, Zhang C. Diffusion Kalman filtering based on covariance intersection. IEEE Trans Signal Process, 2011, 60: 891–902
Battistelli G, Chisci L. Kullback-Leibler average, consensus on probability densities, and distributed state estimation with guaranteed stability. Automatica, 2014, 50: 707–718
Reif K, Gunther S, Yaz E, et al. Stochastic stability of the discrete-time extended Kalman filter. IEEE Trans Automat Contr, 1999, 44: 714–728
Cai B, Yang J, Yuan S, et al. Estimation for fuzzy semi-Markov jump systems with indirectly accessible mode information and nonideal data transmission. IEEE Trans Syst Man Cyber Syst, 2019, 51: 4016–4027
Cai B, Zhang L, Shi Y. Observed-mode-dependent state estimation of hidden semi-Markov jump linear systems. IEEE Trans Automat Contr, 2019, 65: 442–449
Jiang Y, Huang Y, Xue W, et al. On designing consistent extended Kalman filter. J Syst Sci Complex, 2017, 30: 751–764
Bai W, Xue W, Huang Y, et al. On extended state based Kalman filter design for a class of nonlinear time-varying uncertain systems. Sci China Inf Sci, 2018, 61: 042201
Liang C, Xue W, Fang H, et al. On distributed state estimation with bearing measurements. In: Proceedings of the 2022 International Conference on Guidance, Navigation and Control (ICGNC). Singapore: Springer, 2022
Hu J, Wang Z, Liu G P, et al. A prediction-based approach to distributed filtering with missing measurements and communication delays through sensor networks. IEEE Trans Syst Man Cyber Syst, 2020, 51: 7063–7074
Horn R A, Johnson C R. Matrix Analysis. Cambridge: Cambridge University Press, 2012
He X, Xue W, Fang H. Consistent distributed state estimation with global observability over sensor network. Automatica, 2018, 92: 162–172
Rockafellar R T. Convex Analysis. Princeton: Princeton University Press, 1997
Boyd S, Boyd S P, Vandenberghe L. Convex Optimization. Cambridge: Cambridge University Press, 2004
Liang C, Xue W, Fang H. Observability analysis for target tracking systems with bearing measurements. In: Proceedings of the 2020 39th Chinese Control Conference (CCC). Shenyang: IEEE, 2020. 224–229
Author information
Authors and Affiliations
Corresponding author
Additional information
This work was supported by the National Key Research and Development Program of China (Grant No. 2022YFA1004703), the National Natural Science Foundation of China (Grant Nos. 62122083 and 62103014), and the Chinese Academy of Sciences Youth Innovation Promotion Association (Grant No. 2021003).
Rights and permissions
About this article
Cite this article
Liang, C., Xue, W., Fang, H. et al. On distributed Kalman filter based state estimation algorithm over a bearings-only sensor network. Sci. China Technol. Sci. 66, 3174–3185 (2023). https://doi.org/10.1007/s11431-023-2433-6
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s11431-023-2433-6