Elsevier

Automatica

Volume 105, July 2019, Pages 264-273
Automatica

Event-triggered cooperative unscented Kalman filtering and its application in multi-UAV systems

https://doi.org/10.1016/j.automatica.2019.03.029Get rights and content

Abstract

This paper proposes a novel consensus-based distributed unscented Kalman filtering algorithm with event-triggered communication mechanisms. With such an algorithm, each sensor node transmits the newest measurement to the corresponding remote estimator selectively on the basis of its own event-triggering condition. Compared to the existing approaches, the proposed algorithm can significantly reduce unnecessary data transmissions and hence save communication energy consumption and alleviate the communication burden. A sufficient condition is provided to guarantee the stochastic stability of the distributed nonlinear filtering scheme. The proposed algorithm is applicable to a wide range of distributed estimation tasks, e.g., tracking a moving target with multiple unmanned aerial vehicles (UAVs). Simulation results demonstrate the feasibility and effectiveness of the proposed filtering algorithm.

Introduction

The past decades have witnessed ever-increasing research attention devoted to the sensor networks due to its extensive applications in many fields such as battlefield detection, environment monitoring, information processing, autonomous navigation, target tracking and localization. One of the most important problems in sensor networks is designing the functional filtering algorithms to estimate the state of the target process (Olfati-Saber, 2009). Compared with the centralized setting, distributed state estimation without requiring information center has several advantages including stronger fault-tolerance, less computational and communication loads. The central issue in distributed state estimation is to cooperatively estimate the states of a dynamic system via a wireless sensor network with given communication topology. Specifically, each node in such a distributed framework only needs to share information with its neighbors over networks. As a popular approach to address distributed state estimation problem, consensus-based methodologies have made significant progress in recent years (Battistelli and Chisci, 2014, Battistelli and Chisci, 2016, Battistelli et al., 2014, Ji et al., 2017, Kamal et al., 2013, Li et al., 2016, Matei and Baras, 2012, Olfati-Saber, 2007, Olfati-Saber, 2009, Shen et al., 2010). In Olfati-Saber, 2007, Olfati-Saber, 2009, Kalman consensus filters (KCF) are proposed to achieve a consensus in terms of the local state estimates by way of adding a consensus term, which is also applicable to the case with packet dropout. In Matei and Baras (2012), a Luenberger-like consensus algorithm is developed, where every sensor combines its own local estimate computed by the Luenberger observer and the other estimates obtained from its neighboring nodes in a convex manner. In addition, for the uncertain systems, H-consensus performance constraint is introduced in Shen et al. (2010) to quantify the consensus level with regard to the estimation errors.

However, when there exist some non-ideal conditions, such as noisy transmission channel, restricted communication network or limited observability (Ji et al., 2017), the state estimation may be a more troublesome and challenging problem. To overcome these difficulties, an information-weighted consensus filter (ICF) algorithm is discussed in Ji et al., 2017, Kamal et al., 2013. In Battistelli et al. (2014), the stability of the hybrid CMCI (consensus on measurement (Olfati-Saber, 2007) and consensus on information (Battistelli & Chisci, 2014)) filtering algorithm based on the collective observability and network connectivity condition is guaranteed in a linear setting, which is equivalent to ICF with particular weights. When it comes to the nonlinear systems, an alternative extended Kalman filter (EKF) argument is raised in Battistelli and Chisci, 2016, Battistelli et al., 2014, Hu et al., 2012, Li et al., 2016. Similar to Battistelli et al. (2014), the local stability analysis of distributed extended Kalman filter (DEKF) under certain conditions is provided in Battistelli and Chisci (2016). In Li et al. (2016), a variance-constrained DEKF is put forward without omitting the edge-covariances in Olfati-Saber (2009), and the filter gain is obtained by minimizing an upper bound for the estimation error covariance. However, the EKF-based algorithm suffers a number of limitations especially when the system contains high nonlinearities and even discontinuities, which facilitates the development of unscented Kalman filter (UKF)-based algorithm (Julier and Uhlmann, 2004, Li et al., 2015, Li et al., 2016, Li and Xia, 2012, Xiong et al., 2006). In Li et al. (2015), a distributed UKF algorithm based on CI method is proposed, and lately, the weighted average consensus-based UKF is developed with theoretical proof in Li et al. (2016).

In many practical applications of sensor networks, the sensors are battery-powered, which brings about an inevitable issue that replacing or recharging the worn batteries might be impossible in a complicated environment. Thus, it is of particular importance to decrease the frequency of sensor-to-estimator data transmission without compromising the expected estimation performance (Miskowicz, 2006, Wu et al., 2013). A large number of related works considering event-triggered communication mechanism have been reported in Dimarogonas et al., 2012, Li et al., 2016, Li et al., 2017, Liu et al., 2015, Shi et al., 2014, Trimpe, 2014, Zhang and Jia, 2017, Zhang et al., 2016, Zheng and Fang, 2016. Based on the KCF framework in Olfati-Saber (2009), a kind of event-triggered KCF is derived with a named send-on-delta (SoD) schedule (Miskowicz, 2006) on estimator-to-estimator channel to reduce communication energy consumption in Li et al. (2016). An extended work can be found in Zhang and Jia (2017), where the sensor-to-estimator channel is also taken into consideration. However, to the best of our knowledge, there have been very few results about event-triggered UKF algorithm except Li et al. (2017) with only one single sensor considered, even none in distributed setting.

In addition to the theoretical developments, the work presented here is applied in the moving target tracking problem for a team of UAVs equipped with onboard sensors. Mobile UAV sensing platforms have attracted increasing attention in recent years due to the distinctive advantages over their static counterparts with regard to the area coverage, estimation performance and robustness against failure (Campbell and Whitacre, 2007, Hausman et al., 2015, Morbidi and Mariottini, 2013). In Zhan, Casbeer, and Swindlehurst (2010), a centralized adaptive target-tracking algorithm based on the UAV sensors is developed in the EKF framework, which is further investigated in the case where a maneuvering target is tracked with distributed UKF (Li & Jia, 2012) and distributed high degree cubature information filter (Sun & Xin, 2015) in the multiple model environment, respectively. However, the power constraints on small UAVs will limit the practicality of the existing algorithms, in which the data transmissions between individuals and ground stations or among individuals are executed in a periodical fashion. Therefore, the proposed event-triggered cooperative algorithm will be utilized in this application to reach a balance between tracking performance and energy consumption.

The main contributions of this paper are threefold:

  • (1)

    an event-triggered cooperative UKF algorithm is derived, which can well balance the filtering performance and average communication rate by designing reasonable trigger thresholds.

  • (2)

    the stochastic stability of the proposed algorithm in terms of the bounded estimation errors is investigated based on the stochastic stability theory.

  • (3)

    the proposed algorithm is employed in the moving target localization problem with multiple UAVs to show the practical potentials.

The remainder of this paper is organized as follows. Section 2 provides some basic concepts in algebraic graph theory and the mathematical formulation of the considered problem. Section 3 derives the event-triggered cooperative unscented Kalman filtering algorithm, whose stochastic stability will be analyzed in Section 4. Section 5 presents the simulation results illustrating the performance of proposed algorithm for the ground moving target localization with multiple UAVs tracking system. Concluding remarks are stated in Section 6.

Section snippets

Preliminaries and problem formulation

First of all, we present some notations that will be used throughout this paper. Let Rn and Rn×m be a real n-dimensional Euclidean vector space and a real n×m matrix space, respectively. Let λmax() and λmin() be the largest and the smallest eigenvalues of a real matrix. E{} is the expectation operation. represents the Euclidean norm in Rn. For a matrix A, AT and A1 denote its transpose and inverse, respectively. tr{A} denotes the trace of A and A>0 means A is a positive definite matrix.

Event-triggered cooperative unscented Kalman filtering algorithm

In this section, the event-triggered cooperative unscented Kalman filtering algorithm will be derived. Similar to Li et al. (2017), for each estimator node iV, the state estimate update equation is defined by xˆik+1=xˆik+1|k+γk+1iKk+1i(zk+1izˆik+1|k)+(1γk+1i)Mk+1i(zτkiizˆik+1|k). For the convenience of further analysis, the prediction error and estimation error for node i at time instant k+1 are respectively defined as follows x̃k+1|ki=xk+1xˆk+1|ki, x̃k+1i=xk+1xˆk+1i,where xˆk+1|ki

Stability analysis of the proposed algorithm

In this section, the stochastic boundedness of filtering errors in mean square for the event-triggered cooperative UKF algorithm proposed in this paper will be analyzed.

Consider the discrete-time nonlinear system (1), (2). For the convenience of analysis, the approach utilized in Xiong et al. (2006) and Li et al. (2017) is employed herein to simplify the error expressions, namely, x̃k+1|ki=αkiFkix̃ki+ωkz̃k+1i=βk+1iHk+1ix̃k+1|ki+νk+1i, where z̃k+1i=zk+1izˆk+1|ki is the predicted measurement

Numerical results and analysis

This section aims to demonstrate the theoretical results in previous sections via analyzing the effectiveness of the developed algorithm. A practical scenario involving a non-cooperative moving target localization using multiple UAVs is utilized here to justify the potential applicability of the proposed event-triggered distributed filtering scheme.

As stated in Zengin and Dogan (2006), pursuing highly maneuvering targets is regarded as one of the representative applications of multiple UAVs

Conclusions

In this paper, we have investigated the event-triggered communication schedules in weighted average consensus-based UKF framework. A significant reduction of the average sensor-to-estimator communication rate can be realized on basis of the event-triggered communication scheme. Furthermore, we can get a desired balance between filtering performance and communication rate by properly adjusting the triggering threshold. In addition, the guaranteed stability of the proposed algorithm is proved by

Weihao Song received his B.S. degree from Beijing Institute of Technology, Beijing, China, in 2016. He is currently a Ph.D. candidate at Beijing Institute of Technology. His current research interests include distributed filtering and cooperative control.

References (43)

  • BattistelliG. et al.

    Consensus-based linear and nonlinear filtering

    IEEE Transactions on Automatic Control

    (2014)
  • CalafioreG.C. et al.

    Distributed linear estimation over sensor networks

    International Journal of Control

    (2009)
  • CampbellM.E. et al.

    Cooperative tracking using vision measurements on seascan UAVs

    IEEE Transactions on Control Systems Technology

    (2007)
  • CrassidisJ.L. et al.

    Optimal estimation of dynamic systems

    (2004)
  • DimarogonasD.V. et al.

    Distributed event-triggered control for multi-agent systems

    IEEE Transactions on Automatic Control

    (2012)
  • HausmanK. et al.

    Cooperative multi-robot control for target tracking with onboard sensing

    International Journal of Robotics Research

    (2015)
  • JulierS.J. et al.

    Unscented filtering and nonlinear estimation

    Proceedings of the IEEE

    (2004)
  • KamalA.T. et al.

    Information weighted consensus filters and their application in distributed camera networks

    IEEE Transactions on Automatic Control

    (2013)
  • KlugeS. et al.

    Stochastic stability of the extended Kalman filter with intermittent observations

    IEEE Transactions on Automatic Control

    (2010)
  • LeeD.J.

    Nonlinear estimation and multiple sensor fusion using unscented information filtering

    IEEE Signal Processing Letters

    (2008)
  • LiW. et al.

    Consensus-based distributed multiple model UKF for jump Markov nonlinear systems

    IEEE Transactions on Automatic Control

    (2012)
  • Cited by (0)

    Weihao Song received his B.S. degree from Beijing Institute of Technology, Beijing, China, in 2016. He is currently a Ph.D. candidate at Beijing Institute of Technology. His current research interests include distributed filtering and cooperative control.

    Jianan Wang received his B.S. and M.S. in Control Theory and Engineering from the Beijing Jiaotong University and Beijing Institute of Technology, Beijing, China, in 2004 and 2007, respectively. He received his Ph.D. in Aerospace Engineering at Mississippi State University, Starkville, MS, USA in 2011. He is currently an Associate Professor in the School of Aerospace Engineering at Beijing Institute of Technology, Beijing, China. His research interests include cooperative control of multiple dynamic systems, UAV formation control, obstacle/collision avoidance, trustworthy networked system, and estimation of sensor networks. He is a senior member of IEEE and AIAA.

    Shiyu Zhao is an Assistant Professor in the School of Engineering at Westlake University, China, and the Principle Investigator of the Intelligent Unmanned Systems Laboratory. He received the B.E. and M.E. degrees from Beijing University of Aeronautics and Astronautics in 2006 and 2009, respectively. He obtained the Ph.D. degree in Electrical Engineering from the National University of Singapore in 2014. From 2014 to 2016, he served as post-doctoral researchers at the Technion — Israel Institute of Technology and University of California at Riverside. From 2016 to 2018, he was a Lecturer in the Department of Automatic Control and Systems Engineering at the University of Sheffield, UK. He is a corecipient of the Best Paper Award (Guan Zhao-Zhi Award) in the 33rd Chinese Control Conference in 2014. He currently serves as an associate editor of Unmanned Systems and a number of international conferences. His research interests lie in intelligent and network robotic systems.

    Jiayuan Shan received the B.S. degree from Huazhong University of Science and Technology in 1988, and the M.S. and Ph.D. degrees from Beijing Institute of Technology, in 1991 and 1999, respectively. He is currently a Professor in the School of Aerospace Engineering at Beijing Institute of Technology. His research interests include guidance, navigation and control of the aircraft and hardware-in-the-loop simulation. He is the Principal Professor in the direction of Flight Dynamics and Control.

    This work was supported by National Natural Science Foundation of China (Grant Nos. 61873031 and 61503025). The material in this paper was partially presented at the 15th International Conference on Control, Automation, Robotics and Vision, November 18–21, 2018, Singapore. This paper was recommended for publication in revised form by Associate Editor Juan C Aguero under the direction of Editor Torsten Soderstrom.

    View full text