Event-triggered cooperative unscented Kalman filtering and its application in multi-UAV systems☆
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, -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 and be a real -dimensional Euclidean vector space and a real matrix space, respectively. Let and be the largest and the smallest eigenvalues of a real matrix. is the expectation operation. represents the Euclidean norm in . For a matrix , and denote its transpose and inverse, respectively. denotes the trace of and means 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 , the state estimate update equation is defined by For the convenience of further analysis, the prediction error and estimation error for node at time instant are respectively defined as follows where
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, where 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)
- et al.
Kullback-Leibler average, consensus on probability densities, and distributed state estimation with guaranteed stability
Automatica
(2014) - et al.
Stability of consensus extended Kalman filter for distributed state estimation
Automatica
(2016) - et al.
Extended Kalman filtering with stochastic nonlinearities and multiple missing measurements
Automatica
(2012) - et al.
Distributed information-weighted Kalman consensus filter for sensor networks
Automatica
(2017) - et al.
Stochastic stability of the unscented Kalman filter with intermittent observations
Automatica
(2012) - et al.
Consensus-based linear distributed filtering
Automatica
(2012) - et al.
Distributed -consensus filtering in sensor networks with multiple missing measurements: the finite-horizon case
Automatica
(2010) - et al.
An event-triggered approach to state estimation with multiple pointand set-valued measurements
Automatica
(2014) - et al.
Performance evaluation of UKF-based nonlinear filtering
Automatica
(2006) - et al.
Distributed Kalman consensus filter with event-triggered communication: formulation and stability analysis
Journal of the Franklin Institute
(2017)
Consensus-based linear and nonlinear filtering
IEEE Transactions on Automatic Control
Distributed linear estimation over sensor networks
International Journal of Control
Cooperative tracking using vision measurements on seascan UAVs
IEEE Transactions on Control Systems Technology
Optimal estimation of dynamic systems
Distributed event-triggered control for multi-agent systems
IEEE Transactions on Automatic Control
Cooperative multi-robot control for target tracking with onboard sensing
International Journal of Robotics Research
Unscented filtering and nonlinear estimation
Proceedings of the IEEE
Information weighted consensus filters and their application in distributed camera networks
IEEE Transactions on Automatic Control
Stochastic stability of the extended Kalman filter with intermittent observations
IEEE Transactions on Automatic Control
Nonlinear estimation and multiple sensor fusion using unscented information filtering
IEEE Signal Processing Letters
Consensus-based distributed multiple model UKF for jump Markov nonlinear systems
IEEE Transactions on Automatic Control
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.