This paper was converted on www.awesomepapers.org from LaTeX by an anonymous user.
Want to know more? Visit the Converter page.

Minimum-Energy Distributed Filteringthanks: This work was supported by the Australian Research Council under Discovery Projects funding scheme (project D0120102152).

Mohammad Zamani    Valery Ugrinovskii M. Zamani and V. Ugrinovskii are with School of Engineering and IT, UNSW Canberra, Canberra, Australia, Email: {m.zamani,v.ougrinovski}@adfa.edu.au
Abstract

The paper addresses the problem of distributed filtering with guaranteed convergence properties using minimum-energy filtering and HH_{\infty} filtering methodologies. A linear state space plant model is considered observed by a network of communicating sensors, in which individual sensor measurements may lead to an unobservable filtering problem. However, each filter locally shares estimates, that are subject to disturbances, with its respective neighboring filters to produce an estimate of the plant state. The minimum-energy strategy of the proposed local filter leads to a locally optimal time-varying filter gain facilitating the transient and the asymptotic convergence of the estimation error, with guaranteed HH_{\infty} performance. The filters are implementable using only the local measurements and information from the neighboring filters subject to disturbances. A key idea of the proposed algorithm is to locally approximate the neighboring estimates, that are not directly accessible, considering them as disturbance contaminated versions of the plant state. The proposed algorithm imposes minimal communication load on the network and is scalable to larger sensor networks.

I INTRODUCTION

There is considerable interest in the literature in multi-agent systems that are capable of performing control and filtering related tasks in a cooperative manner. Applications range from military aerial fleets, monitoring and maintenance agents in industrial applications to biological applications. In this paper, in particular, we are concerned with distributed filtering using a network of filters that estimate the state of a plant using disturbance contaminated local measurements. An interesting case is when these filters individually have difficulty providing an accurate and complete estimate of the plant, a problem that is resolved by using information from the neighbouring filters.

Kalman filtering is the focus of many of the existing methods proposed for distributed filtering. An early result on this subject by Durrant-Whyte et. al [1, 2] provides an exact decentralized formulation for the multi-sensor version of the Kalman filter. This formulation avoids the requirement of a central processing or communication unit with which each sensor has to communicate its information for calculating the state estimate of the plant. The decentralized scheme is robust to sensor failure and network changes, reduces the communication load and allows for faster information processing. The decentralized Kalman filter proposed in [1, 2] however, requires an all-to-all communication of state error information and variance error information between the sensors; this impairs its scalability to bigger networks. Olfati-Saber [3] proposed a distributed Kalman filter algorithm that involves two additional consensus filters which are needed for fusion of the sensor information and covariance information required for the decentralized Kalman filtering scheme used. The distributed naming refers to the fact that all-to-all information sharing is avoided and instead each agent only shares information with its local neighbors. The distributed consensus algorithms proposed in [3] assume disturbance free data sharing between the sensors that is arguably an unrealistic assumption in applications involving imperfect communication.

More recently, observer designs based on linear matrix inequalities (LMIs) have been employed to tackle the imperfect communication problem in multi-agent distributed estimation [4, 5]. Subbotin and Smith [5] proposed a convex optimization problem where minimizing the estimation error covariance of the global network selects the local observer gains. Ugrinovskii [4] designed the observer gains by minimizing an HH_{\infty} consensus performance cost that guarantees the associated disturbance attenuation criterion and guarantees the convergence of the filter dynamics of the nodes. Both works target the asymptotic performance of their respective estimation algorithms by using constant gains. This is in contrast to filtering algorithms that use time-varying gains calculated to adjust both the transient and the asymptotic performance  [6].

In this paper a minimum-energy distributed filtering algorithm is proposed that addresses the imperfect communication of the nodes by locally minimizing a quadratic energy cost comprising the initialization and measurement errors as well as the communication errors of the local filter. A novel contribution of this paper that leads to the distributed nature of the local filters lies in augmenting the minimum-energy cost functional with a cost on approximating the neighboring estimates. Furthermore, a penalty is included in the local costs that provides a guaranteed HH_{\infty} disturbance attenuation property over the network of filters.

We provide a condition on the network parameters that is sufficient to ensure convergence of the proposed filters. The condition is quite general, and captures the types of convergence considered in [4, 5] as special cases. Moreover, we offer a tuning algorithm based on LMIs that facilitates the implementation of the proposed filters with guaranteed HH_{\infty} performance and convergence of the filters. A simulation example regarding the Chua electronic circuit [7] is provided that demonstrates the effectiveness of the proposed algorithm in the case of a chaotic plant system and network of five filters that estimate the state of the plant.

The remainder of the paper is organised as follows. Section II reviews the concept of minimum-energy filtering. In Section III we extend the minimum-energy filtering paradigm to allow for a distributed filtering formulation as well as to impose the HH_{\infty} filtering performance criterion. The distributed minimum-energy filter is provided in that section. Convergence of the proposed filter is studied in Section IV, and tuning of the filter is discussed in Section V. Section VI illustrates the design procedure and performance of the proposed filter via simulation, and Section VII concludes the paper.

II Minimum-Energy Filtering

In this section we review the concept of minimum-energy filtering that was pioneered by Mortensen [8] and was further elaborated by Hijab [9]. Later, we use this method to obtain a distributed filtering algorithm for estimating the state of a linear system using a network of filters. Consider the linear system

x˙=Ax+Bw,x(0)=x0,\dot{x}=Ax+Bw,\quad x(0)=x_{0}, (1)

where the signals xnx\in\mathbb{R}^{n} and wmw\in\mathbb{R}^{m} are, respectively, the state and the unknown modeling disturbance; the latter is assumed to be 2\mathcal{L}_{2} integrable on [0,T][0,T]. The matrices An×nA\in\mathbb{R}^{n\times n} and Bn×mB\in\mathbb{R}^{n\times m} are known state matrix and input disturbance coefficient matrix, respectively. Note that x0x_{0} is assumed to be unknown.

Further consider the following measurement model

y=Cx+Dv,y=Cx+Dv, (2)

where the signals y,vpy,v\in\mathbb{R}^{p} are the measured data and the unknown measurement disturbance, which is also assumed to be 2\mathcal{L}_{2} integrable on [0,T][0,T]. The matrices Cp×nC\in\mathbb{R}^{p\times n} and Dp×pD\in\mathbb{R}^{p\times p} are the measurement matrix and the measurement disturbance coefficient matrix, receptively, that are assumed to be known from the model. Denote QBBQ\triangleq BB^{\top} and RDDR\triangleq DD^{\top} and assume that R>0R>0.

Associated with these equations is the energy functional measuring the aggregated energy associated with the unknowns (x0,w,v)(x_{0},w,v),

Jt=12x0ξ𝒳2+120t(w2+v2)𝑑τ,J_{t}=\frac{1}{2}\|x_{0}-\xi\|_{\mathcal{X}}^{2}+\frac{1}{2}\int_{0}^{t}\left(\|w\|^{2}+\|v\|^{2}\right)d\tau, (3)

where aAaAa\|a\|_{A}\triangleq a^{\top}Aa, the matrix 𝒳n×n\mathcal{X}\in\mathbb{R}^{n\times n} is a weighting on the difference between the unknown initial state and its nominated a priori estimate ξ\xi.

Denote by y[0,t]y_{[0,t]} the data obtained according to (2) during the time [0,t][0,t]. Given the measurement data y[0,t]y_{[0,t]}, minimizing the cost (3) with respect to ww and x(0)x(0), subject to equations (1) and (2), leads to an optimal state trajectory x[0,t]x^{*}_{[0,t]}. This is the ‘most likely trajectory’ [8] or the minimum-energy trajectory that is compatible with the data y[0,t]y_{[0,t]}. The end point of this trajectory constitutes the minimum-energy estimate of the state x(t)x(t), given the measurement data y[0,t]y_{[0,t]},

x^(t)x[0,t](t),t[0,T].\hat{x}(t)\triangleq x^{*}_{[0,t]}(t),\quad t\in[0,T]. (4)

It is desirable to obtain the estimates x^(t)\hat{x}(t) continuously as time evolves in [0,T][0,T]. Note that in general, for 0t1<t2T0\leq t_{1}<t_{2}\leq T,

x^(t1)=x[0,t1](t1)x[0,t2](t1).\hat{x}(t_{1})=x^{*}_{[0,t_{1}]}(t_{1})\not=x^{*}_{[0,t_{2}]}(t_{1}). (5)

Therefore, it is not sufficient to only minimize the cost (3) over [0,T][0,T] and infinite sequence of minimizations are required if all the estimated values in this period are needed. The calculus of variations can be utilized to solve this problem and obtain a recursive filtering algorithm similar to those arising in optimal control [10]. The idea is to solve the following two step optimization problem

infx(0)(infwJt)=infx(0)[12x(0)ξ𝒳2+infw120t(w2+yCxR12)dτ].\begin{split}\inf_{x(0)}(\inf_{w}J_{t})=&\inf_{x(0)}\left[\frac{1}{2}\|x(0)-\xi\|_{\mathcal{X}}^{2}\right.\\ &+\left.\inf_{w}\frac{1}{2}\int_{0}^{t}(\|w\|^{2}+\|y-Cx\|_{R^{-1}}^{2})d\tau\right].\end{split} (6)

The inner minimization problem is solved as an optimal tracking problem, in which the system (1) is to track the given output signal y(τ)y(\tau), τ[0,t]\tau\in[0,t], and ww is treated as a control input signal. For this step both x(0)x(0) and x(t)=xx(t)=x are considered to be fixed but constrained by (1) for 0τt0\leq\tau\leq t. The associated value function of this inner tracking problem, encoding the minimum energy required to take the system from the initial state x(0)x(0) to the state xx over the time period [0,t][0,t], is

V(x,t)=minwJt,V(x,t)=\min_{w}J_{t}, (7)

which from (3) has the initial condition

V(x,0)=12xξ𝒳2.V(x,0)=\frac{1}{2}\|x-\xi\|_{\mathcal{X}}^{2}. (8)

Note that in (7), the variables xx and tt are considered as independent variables. That is, by selecting a time tt and an end state xx, the value function (7) provides the optimal value arising from minimizing the cost (3) over ww.

The final step is to perform the outer minimization, which is equivalent to minimizing the value function over xx. This leads to the optimal trajectory xx^{*} and the minimum-energy estimate chosen as its final value, x^(t)=x(t)\hat{x}(t)=x^{*}(t). Provided the value function is sufficiently smooth, this can be achieved by solving

xV(x,t)=0.\nabla_{x}V(x,t)=0. (9)

Mortensen [8] proposed solving the next equation, obtained from (9), that leads to a recursive set of equations for updating x^(t)\hat{x}(t).

ddt{xV(x,t)}=0.\dfrac{d}{dt}\{\nabla_{x}V(x,t)\}=0. (10)

The resulting filter turns out to be in the exact form of the Kalman-Bucy filter [6]. While the resulting filter is well-known in the literature, the minimum-energy methodology is less known. Nevertheless, minimum-energy filtering is a systematic recursive method that can be applied in many applications including in distributed filtering considered in the rest of this paper.

III Minimum-Energy Distributed Filtering

Consider a network of NN filters with a directed graph topology 𝐆=(𝐕,𝐄)\mathbf{G}=(\mathbf{V},\mathbf{E}) where 𝐕\mathbf{V} and 𝐄𝐕×𝐕\mathbf{E}\subseteq\mathbf{V}\times\mathbf{V} are the set of vertices and the set of edges, respectively. An edge directing node jj of the graph 𝐆\mathbf{G} towards node ii where i,j{1,,N}i,j\in\{1,\cdots,N\} is denoted by (i,j)(i,j). In accordance with the common convention [3], the graph 𝐆\mathbf{G} is assumed to have no self-loops, i.e., (i,i)𝐄(i,i)\notin\mathbf{E}. The neighborhood of node ii, i.e., the set of nodes which send information to node ii, is denoted by 𝒩i={j:(i,j)𝐄}\mathcal{N}_{i}=\{j:(i,j)\in\mathbf{E}\}.

In this section we again consider the plant model (1). As in Section II, the initial state x0x_{0} and the 2\mathcal{L}_{2}-integrable modeling error ww are unknown. Our goal is to construct a network of filters that can each estimate the plant state xx using the measurements of the following type,

yi=Cix+Divi,y_{i}=C_{i}x+D_{i}v_{i}, (11)

where i=1,2,,Ni=1,2,\cdots,N, indicates the iith node of the network. Each measurement yipy_{i}\in\mathbb{R}^{p} is obtained using the associated observation matrix Cip×nC_{i}\in\mathbb{R}^{p\times n} known to node ii from the model. The signal vipv_{i}\in\mathbb{R}^{p} is an unknown measurement error assumed to be 2\mathcal{L}_{2} integrable on [0,T][0,T], with known coefficient matrices Dip×pD_{i}\in\mathbb{R}^{p\times p} such that the matrix RiDiDiR_{i}\triangleq D_{i}D_{i}^{\top} is positive definite.

In addition, the filter ii obtains information from lil_{i} agents in its neighbourhood 𝒩i\mathcal{N}_{i}; lil_{i} is the cardinality of the set 𝒩i\mathcal{N}_{i}, 0liN0\leq l_{i}\leq N. The obtained signals at node ii are

cij=Wijx^j+Fijϵij,j𝒩i,c_{ij}=W_{ij}\hat{x}_{j}+F_{ij}\epsilon_{ij},\quad j\in\mathcal{N}_{i}, (12)

where x^j\hat{x}_{j} is the estimate of state xx at node j𝒩ij\in\mathcal{N}_{i}. Similar to the measurements yiy_{i}, the signals cijmc_{ij}\in\mathbb{R}^{m} are obtained using the weighted connectivity matrices Wijm×nW_{ij}\in\mathbb{R}^{m\times n} that are assumed to be known to node ii while x^j\hat{x}_{j} are not known. The signals ϵijm\epsilon_{ij}\in\mathbb{R}^{m} are unknown communication errors of class 2[0,T]\mathcal{L}_{2}[0,T], with known coefficient matrices Fijm×mF_{ij}\in\mathbb{R}^{m\times m} such that SijFijFijS_{ij}\triangleq F_{ij}F_{ij}^{\top} are positive definite.

Remark 1

An interesting situation arises when some or all the pairs (A,Ci)(A,C_{i}) are not detectable and hence the state xx cannot be estimated at the corresponding filter nodes from yiy_{i} only. Forming a large-scale distributed observer network by enabling the filters to obtain information about the state estimates of their neighboring filters allows these nodes to overcome the lack of detectability and provide a reliable state estimate x^in\hat{x}_{i}\in\mathbb{R}^{n}, e.g., see [11] where this issue is discussed in detail. It should be noted that the distributed filtering problem under consideration is different from a centralized filtering scheme where all the measurements yiy_{i} are sent to a central processing unit to obtain an estimate of the plant’s state. In a centralized scheme the computational complexity at the central node, communication load on the network and scalability are the common issues that distributed filtering aims to address.

In many existing methodologies, cf. [4, 7, 5], treating communications between the nodes as extra measurements results in observer design conditions that require solving large-scale coupled matrix equations or matrix inequalities. In contrast, we invoke the following equation that is going to be instrumental in obtaining decoupled filter gain conditions. Since x^j\hat{x}_{j} are meant to represent the state vector xx with high fidelity, we use the following model at node ii,

x^j=x+ηij.\hat{x}_{j}=x+\eta_{ij}. (13)

The signals ηijb\eta_{ij}\in\mathbb{R}^{b} denote the unknown error signals of this assignment. Note that this model is only proposed for node ii and node jj obviously computes x^j\hat{x}_{j} using its corresponding filter.

Next, we pose a minimum-energy filtering problem to obtain a distributed filter at each node ii such that a cost functional, depending on the unknown initial state of the plant x0x_{0} and the unknown errors in the measurements and neighbouring information associated to filter ii, is minimized. This cost functional is in fact the sum of aggregated energies in the unknowns of the model, the measurements and the neighbouring information associated with filter ii. Note that the distributed estimation paradigm restricts us to only utilizing local measurements yiy_{i} and local information from the neighboring nodes, i.e. cij,j𝒩ic_{ij},\;j\in\mathcal{N}_{i} in this optimization process. It is important to stress the role of the unknown signals ηij\eta_{ij} that are also to be optimized over in this process.

The idea behind minimizing the cost functional over ηij\eta_{ij}, j𝒩ij\in\mathcal{N}_{i}, amounts to agent ii relying on the fact that its neighboring agents are also minimum-energy type estimators of the plant state and hence their estimates can be thought of as estimates of the plant state contaminated with errors that are based on minimum-energy filtering too. This is a key idea among the results of this work that facilitates obtaining a distributed solution for our problem. The concept of minimum-energy filtering was explained in details in Section II.

The energy cost similar to (3), associated with the system (1), the information available to node ii according to (11) and (12), and the approximation model (13) is defined as

12x0ξi𝒳i2+120t(w2+vi2+j𝒩i(ϵij2+ηijZij12))dτ,\begin{split}&\frac{1}{2}\|x_{0}-\xi_{i}\|_{\mathcal{X}_{i}}^{2}+\frac{1}{2}\int_{0}^{t}\bigg{(}\|w\|^{2}+\|v_{i}\|^{2}\\ &\qquad\qquad\qquad+\sum_{j\in\mathcal{N}_{i}}(\|\epsilon_{ij}\|^{2}+\|\eta_{ij}\|^{2}_{Z^{-1}_{ij}})\bigg{)}d\tau,\end{split} (14)

where the signal ξi\xi_{i} is an a priori candidate for the initial state x0x_{0} at node ii and the matrix 𝒳i\mathcal{X}_{i} is an a priori known weighting for the initialization error x0ξix_{0}-\xi_{i}. The weighting matrices Zij=Zij>0Z_{ij}=Z_{ij}^{\prime}>0, Zijn×nZ_{ij}\in\mathbb{R}^{n\times n}, quantify the ‘confidence’ of node ii in the quality of its neighbor estimates x^j\hat{x}_{j} and are selected locally by node ii.

Given the measurement data yi|[0,t]y_{i}|_{[0,t]} and the communication data cij|[0,t]c_{ij}|_{[0,t]}, the signals viv_{i} and ϵij\epsilon_{ij} are identified as dependent variables and the energy cost functional (14) has arguments x0x_{0}, wiw_{i} and ηij\;\eta_{ij}. Next, based on (14) define the following cost functional for node ii

Ji,t(x0,w,{ηij})=12x0ξi𝒳i2+120t(w2\displaystyle J_{i,t}(x_{0},w,\{\eta_{ij}\})=\frac{1}{2}\|x_{0}-\xi_{i}\|_{\mathcal{X}_{i}}^{2}+\frac{1}{2}\int_{0}^{t}\bigg{(}\|w\|^{2}
+yiCixRi12+j𝒩i(cijWijxWijηijSij12\displaystyle\quad+\|y_{i}-C_{i}x\|^{2}_{R_{i}^{-1}}+\sum_{j\in\mathcal{N}_{i}}(\|c_{ij}-W_{ij}x-W_{ij}\eta_{ij}\|^{2}_{S_{ij}^{-1}}
+ηijZij12xx^iMi12))dτ,\displaystyle\quad+\|\eta_{ij}\|^{2}_{Z^{-1}_{ij}}-\|x-\hat{x}_{i}\|^{2}_{M_{i}^{-1}})\bigg{)}d\tau, (15)

where the matrix Mi>0n×nM_{i}>0\in\mathbb{R}^{n\times n} is a given coefficient. The selection of this matrix will be discussed in Section V. The inclusion of the error term 0txx^iMi12𝑑τ\int_{0}^{t}\|x-\hat{x}_{i}\|^{2}_{M_{i}^{-1}}d\tau with a negative sign enforces a guaranteed HH_{\infty} type performance at node ii while a minimum-energy estimate is sought [12].

The principle of minimum energy requires that a set of the unknowns (x0,w,ηij)(x_{0},w,\eta_{ij}), j𝒩ij\in\mathcal{N}_{i}, be sought at each node ii that are compatible with the measurements yiy_{i} and the neighbourhood information cijc_{ij} in satisfying (11), (12) and (13) while minimizing the cost (15),

infxinfw,ηijJi,t(x0,w,ηij),\inf_{x}\;\inf_{w,\;\eta_{ij}}J_{i,t}(x_{0},w,\eta_{ij}), (16)

where x=x(t)x=x(t). Using the minimum energy filtering approach as was explained in Section II the following filter is obtained

x^˙i\displaystyle\dot{\hat{x}}_{i} =\displaystyle= Ax^i+Ki1(CiR1(yiCix^i)\displaystyle A\hat{x}_{i}+K_{i}^{-1}\bigg{(}C_{i}^{\top}R^{-1}(y_{i}-C_{i}\hat{x}_{i}) (17)
+\displaystyle+ j𝒩iWijUij1(cijWijx^i)),x^i(0)=ξi.\displaystyle\sum_{j\in\mathcal{N}_{i}}W_{ij}^{\top}U^{-1}_{ij}(c_{ij}-W_{ij}\hat{x}_{i})\bigg{)},\quad\hat{x}_{i}(0)=\xi_{i}.

The matrix UijU_{ij} is defined as UijSij+WijZijWijU_{ij}\triangleq S_{ij}+W_{ij}Z_{ij}W_{ij}^{\top}. The positive definite time-varying gain matrix KiK_{i} is calculated from the following Riccati equation

K˙i\displaystyle\dot{K}_{i} =\displaystyle= KiQKi+CiRi1Ci+j𝒩iWijUij1Wij\displaystyle-K_{i}QK_{i}+C_{i}^{\top}R_{i}^{-1}C_{i}+\sum_{j\in\mathcal{N}_{i}}W_{ij}^{\top}U^{-1}_{ij}W_{ij} (18)
Mi1AKiKiA,\displaystyle-M_{i}^{-1}-A^{\top}K_{i}-K_{i}A,
Ki(0)\displaystyle\quad K_{i}(0) =\displaystyle= 𝒳i.\displaystyle\mathcal{X}_{i}.

The matrix QQ is defined as QBBQ\triangleq BB^{\top} where BB was given in (1).

An advantage of equation (18) is that it does not depend on any measurements, neighbour information or any on-line acquired data and hence can be fully solved off-line. It can also be solved on-line forward in time, so that the computed values for Ki(t)K_{i}(t) can be used to dynamically run the observer (17). Also, the filter equation (17) has the standard form of a distributed filter that produces state estimates based on local measurements and information obtained about the neighbours. A noteworthy feature of the proposed filter is that its gains are dependent only on the information available at node ii. The only matrix to be computed to find the gains, the matrix KiK_{i} is computed locally, without interacting with the neighbours, provided the matrices MiM_{i} are defined a priori. This feature of the proposed minimum energy estimator sets it apart from other distributed estimation algorithms such as those proposed in [4, 5].

IV Convergence Analysis

In this section we provide sufficient conditions to guarantee that the interconnected network of filters designed according to equations (17) and (18) converges to the true state of the plant as tt\to\infty. Due to the presence of uncertainty, the convergence is understood in the HH_{\infty} sense. Firstly, we show that error dynamics exhibit properties of an internally stable system. The notion of internal stability is equivalent to asymptotic convergence of the estimation error of the network in the absence of disturbance signals. Secondly, we will show that when disturbances are 2\mathcal{L}_{2} integrable on [0,)[0,\infty), the filter ensures disturbance attenuation properties similar to those of an HH_{\infty} filter.

Consider the node error eix^ixe_{i}\triangleq\hat{x}_{i}-x and its dynamics,

e˙i=AeiBw\displaystyle\hskip-21.52771pt\dot{e}_{i}=Ae_{i}-Bw
Ki1((CiRi1Ci+j𝒩iWijUij1Wij)ei\displaystyle\hskip-10.76385pt-K_{i}^{-1}\bigg{(}(C_{i}^{\top}R_{i}^{-1}C_{i}+\sum_{j\in\mathcal{N}_{i}}W_{ij}^{\top}U^{-1}_{ij}W_{ij})e_{i}
CiRi1Divij𝒩iWijUij1(Wijej+Fijϵij)),\displaystyle\hskip-10.76385pt-C_{i}^{\top}R^{-1}_{i}D_{i}v_{i}-\sum_{j\in\mathcal{N}_{i}}W_{ij}^{\top}U^{-1}_{ij}(W_{ij}e_{j}+F_{ij}\epsilon_{ij})\bigg{)}, (19)

where the dynamics of the matrix KiK_{i} are given in (18).

Let us introduce the following notation

e[e1,,eN],A~INA,Cdiag[C1,,CN],Q~INQ,Rdiag[R1,,RN],Kdiag[K1,,KN],Mdiag[M1,,MN],Δdiag[j𝒩1W1jU1j1W1j,,j𝒩NWNjUNj1WNj],Δ~diag[j𝒩1W1jU1j1W1jZ1jW1jU1j1W1j,,j𝒩NWNjUNj1WNjZNjWNjUNj1WNj],L~[Lij],Lij={j𝒩iWijUij1WijZijWijUij1Wij,i=j,WijUij1Wij,ij,j𝒩i,0,ij,j𝒩i,\begin{split}&e\triangleq[e_{1}^{\top},\ldots,e_{N}^{\top}]^{\top},\\ &\tilde{A}\triangleq I_{N}\otimes A,\quad C\triangleq\mbox{diag}[C_{1},\ldots,C_{N}],\quad\tilde{Q}\triangleq I_{N}\otimes Q,\\ &R\triangleq\mbox{diag}[R_{1},\ldots,R_{N}],\quad K\triangleq\mbox{diag}[K_{1},\ldots,K_{N}],\\ &M\triangleq\mbox{diag}[M_{1},\ldots,M_{N}],\\ &\Delta\triangleq\mbox{diag}[\sum_{j\in\mathcal{N}_{1}}W_{1j}^{\top}U^{-1}_{1j}W_{1j},\ldots,\sum_{j\in\mathcal{N}_{N}}W_{Nj}^{\top}U^{-1}_{Nj}W_{Nj}],\\ &\tilde{\Delta}\triangleq\mbox{diag}[\sum_{j\in\mathcal{N}_{1}}W_{1j}^{\top}U^{-1}_{1j}W_{1j}Z_{1j}W_{1j}^{\top}U^{-1}_{1j}W_{1j},\ldots,\\ &\quad\quad\quad\sum_{j\in\mathcal{N}_{N}}W_{Nj}^{\top}U^{-1}_{Nj}W_{Nj}Z_{Nj}W_{Nj}^{\top}U^{-1}_{Nj}W_{Nj}],\\ &\tilde{L}\triangleq[L_{ij}],\\ &L_{ij}=\begin{cases}\sum_{j\in\mathcal{N}_{i}}W_{ij}^{\top}U_{ij}^{-1}W_{ij}Z_{ij}W_{ij}^{\top}U_{ij}^{-1}W_{ij},\\ &\hskip-56.9055pti=j,\\ -W_{ij}^{\top}U^{-1}_{ij}W_{ij},&\hskip-56.9055pti\neq j,\ j\in\mathcal{N}_{i},\\ 0,&\hskip-56.9055pti\neq j,\ j\not\in\mathcal{N}_{i},\end{cases}\end{split} (20)

where diag[X1,,XN]\mbox{diag}[X_{1},\ldots,X_{N}] denotes the block diagonal matrix with X1,,XNX_{1},\ldots,X_{N} as its diagonal blocks, and \otimes is the Kronecker product of matrices. Using this notation, KK satisfies the differential Riccati equation

K˙\displaystyle\dot{K} =\displaystyle= KQ~K+CR1C+ΔM1\displaystyle-K\tilde{Q}K+C^{\top}R^{-1}C+\Delta-M^{-1} (21)
A~KKA~,\displaystyle-\tilde{A}^{\top}K-K\tilde{A},
K(0)\displaystyle K(0) =\displaystyle= diag[𝒳1,,𝒳N].\displaystyle\mbox{diag}[\mathcal{X}_{1},\ldots,\mathcal{X}_{N}].

The following theorem is the main result of this paper, which characterizes HH_{\infty} performance of the distributed minimum energy filter (17).

Theorem 1

Given a positive semidefinite weighting matrix P=PnN×nNP=P^{\prime}\in\mathbb{R}^{nN\times nN}, suppose a block diagonal matrix M=M>0M=M^{\top}>0 is such that

M1>PL~L~+Δ~M^{-1}>P-\tilde{L}-\tilde{L}^{\top}+\tilde{\Delta} (22)

and each Riccati equation (18) has a positive definite bounded solution on [0,)[0,\infty). Then, the filtering algorithm (17), (18) guarantees the satisfaction of the global disturbance attenuation criterion111In (23), 2\|\cdot\|_{2} denotes the norm in 2[0,)\mathcal{L}_{2}[0,\infty).

0ePe𝑑τ\displaystyle\int_{0}^{\infty}e^{\top}Ped\tau \displaystyle\leq i=1Nx0ξi𝒳i2+Nw22\displaystyle\sum_{i=1}^{N}\|x_{0}-\xi_{i}\|^{2}_{\mathcal{X}_{i}}+N\|w\|_{2}^{2} (23)
+\displaystyle+ i=1N(vi22+j𝒩iϵij22).\displaystyle\sum_{i=1}^{N}\left(\|v_{i}\|_{2}^{2}+\sum_{j\in\mathcal{N}_{i}}\|\epsilon_{ij}\|_{2}^{2}\right).

Moreover, in the absence of the disturbances w,vi,ϵijw,v_{i},\epsilon_{ij}, j𝒩ij\in\mathcal{N}_{i}, i=1,,Ni=1,\ldots,N, the global estimation error ee asymptotically converges to zero as tt\to\infty.

The proof is omitted due to page restrictions.

Several special cases of Theorem 1 deserve attention.

Minimum energy filter with guaranteed HH_{\infty} convergence performance

In this special case, the performance objective of interest is to achieve the internal stability of the filtering error dynamics, and enforce an acceptable disturbance attenuation performance of the filter error dynamics. Let P=diag[P1,PN]P=\mbox{diag}[P_{1}\cdots,P_{N}], Pi=Pi>0P_{i}=P_{i}^{\prime}>0. Then the conditions of Theorem 1 specialize to guarantee the following HH_{\infty} condition

i=1N0eiPiei𝑑τ\displaystyle\sum_{i=1}^{N}\int_{0}^{\infty}e_{i}^{\top}P_{i}e_{i}d\tau \displaystyle\leq i=1Nx0ξi𝒳i2+Nw22\displaystyle\sum_{i=1}^{N}\|x_{0}-\xi_{i}\|^{2}_{\mathcal{X}_{i}}+N\|w\|_{2}^{2} (24)
+\displaystyle+ i=1N(vi22+j𝒩iϵij22).\displaystyle\sum_{i=1}^{N}\left(\|v_{i}\|_{2}^{2}+\sum_{j\in\mathcal{N}_{i}}\|\epsilon_{ij}\|_{2}^{2}\right).

Minimum energy filter with guaranteed transient HH_{\infty} consensus performance

Consider P=12(L+L)P0P=\frac{1}{2}(L+L_{\top})\otimes P_{0} where P0=P00P_{0}=P_{0}^{\prime}\geq 0, and LL, LL_{\top} are respectively the Laplace matrix of the network graph and that of its transpose, i.e., the graph obtained from the network graph by reversing its edges. This choice of PP results in the left hand side of the (23) being equal to the weighted HH_{\infty} disagreement cost between the nodes 120ij𝒩ix^ix^jP02dτ\frac{1}{2}\int_{0}^{\infty}\sum_{i}\sum_{j\in\mathcal{N}_{i}}\|\hat{x}_{i}-\hat{x}_{j}\|_{P_{0}}^{2}d\tau; cf. [4, 7]. Therefore, if P0P_{0} is such that the conditions of Theorem 1 are satisfied, then this choice of PP adjusts the filter to guarantee the HH_{\infty} consensus performance,

120i=1Nj𝒩ix^ix^jP02dτi=1Nx0ξi𝒳i2+Nw22+i=1N(vi22+j𝒩iϵij22).\frac{1}{2}\int_{0}^{\infty}\sum_{i=1}^{N}\sum_{j\in\mathcal{N}_{i}}\|\hat{x}_{i}-\hat{x}_{j}\|_{P_{0}}^{2}d\tau\leq\sum_{i=1}^{N}\|x_{0}-\xi_{i}\|^{2}_{\mathcal{X}_{i}}\\ +N\|w\|_{2}^{2}+\sum_{i=1}^{N}\left(\|v_{i}\|_{2}^{2}+\sum_{j\in\mathcal{N}_{i}}\|\epsilon_{ij}\|_{2}^{2}\right). (25)

V Network Design and Tuning

Theorem 1 provides a sufficient condition guaranteeing the convergence in the HH_{\infty} sense of the network of filters consisting of the estimators (17), (18). To apply this condition the matrices MiM_{i} need to be selected to satisfy (22). The following propositions are instrumental in designing these matrices. First, we recall a connection between the differential Riccati equation (18) and a corresponding algebraic Riccati equation (ARE) [13],

ZiA+AZi\displaystyle Z_{i}A^{\top}+AZ_{i} \displaystyle- Zi(CiRi1Ci\displaystyle Z_{i}(C_{i}^{\top}R_{i}^{-1}C_{i} (26)
+\displaystyle+ [Δ]iiMi1)Zi+BB=0.\displaystyle[\Delta]_{ii}-M_{i}^{-1})Z_{i}+BB^{\top}=0.
Proposition 1

If the (ARE) (26) has a positive definite stabilizing solution Zi+Z_{i}^{+} then the equation (18) with an initial condition Ki(0)=𝒳i(Zi+)1K_{i}(0)=\mathcal{X}_{i}\geq(Z_{i}^{+})^{-1} has a bounded positive definite solution on [0,)[0,\infty) and limtKi(t)(Zi+)1\lim_{t\to\infty}K_{i}(t)\to(Z_{i}^{+})^{-1}.

Next, we use the above connection between the ARE (26) and the differential Riccati equation (18) to derive a tractable sufficient condition for the conditions of Theorem 1 to hold.

Theorem 2

Suppose (A,B)(A,B) is stabilizable, and MM and PP are the matrices defined in Theorem 1. The linear matrix inequality (LMI) conditions

[AXi+XiACiRi1Ci[Δ]ii+Mi1XiBBXiI]<0,\displaystyle\hskip-14.22636pt\left[\begin{array}[]{cc}A^{\top}X_{i}+X_{i}A-C_{i}^{\top}R_{i}^{-1}C_{i}-[\Delta]_{ii}+M_{i}^{-1}&X_{i}B\\ B^{\top}X_{i}&-I\end{array}\right]<0, (29)
Xi=Xi>0,i=1,,N,\displaystyle X_{i}=X_{i}^{\top}>0,\quad i=1,\ldots,N,
L~+L~Δ~+M1>P\displaystyle\tilde{L}+\tilde{L}^{\top}-\tilde{\Delta}+M^{-1}>P (30)

guarantee the satisfaction of the conditions of Theorem 1 for any sufficiently large 𝒳i\mathcal{X}_{i}.

In the light of Theorem 2, solving the LMI (30) in variables XiX_{i}, Mi1M_{i}^{-1}, PP is considered as a tuning process for the proposed filtering algorithm (17), (18). Tuning can be carried out, e.g., using MATLAB. It can be performed assuming the matrix PP is given, to obtain the matrices Mi1M_{i}^{-1} and 𝒳i\mathcal{X}_{i} to be used in equation (18). According to Theorem 1, this tuning process will guarantee the disturbance attenuation and the internal stability of the error dynamics for the entire networked filter consisting of the node filters (17), (18). Alternatively, the matrices MiM_{i}, i=1,Ni=1\ldots,N, can be selected a priori. The filter gain equations (18) are completely decoupled in this case, and Theorem 2 can be used to compute the matrix PP to characterize performance of the corresponding distributed filter (17).

VI Illustrative Example

In this section, a simulated network of five sensor nodes is considered that are to estimate a three-dimensional plant. The plant’s state matrix is given by

A=[3.2100111014.870].A=\left[\begin{array}[]{ccc}-3.2&10&0\\ 1&-1&1\\ 0&-14.87&0\\ \end{array}\right]. (31)

This corresponds to a Chua electronic circuit which was considered in [7]. A Chua circuit is a chaotic system switching between three regimes of operation. Here, we focus on one of the regimes and consider the second mode of the Chua example that was considered in [7]. The CiC_{i} matrices considered are C1=C4=0.001[3.19234.65971]C_{1}=C_{4}=0.001[3.1923~−4.6597~1] and C2=C3=C5=[0.89860.13121.9703]C_{2}=C_{3}=C_{5}=[−0.8986~0.1312~−1.9703]. The network considered consists of five nodes with connectivity edges E={(1,3),(2,3),(3,1),(3,2),(3,4),(4,3),(4,5),(5,4)}E=\{(1,3),(2,3),(3,1),(3,2),(3,4),(4,3),(4,5),(5,4)\}. Following [7], all communication matrices associated with the sensor nodes ii and jj are taken to be Wij=I3×3W_{ij}=I_{3\times 3} if the pair (i,j)(i,j) belongs to the set of edges EE, and otherwise Wij=03×3W_{ij}=0_{3\times 3}.

We have considered the remainder of the coefficient matrices to be B=0.4I3×3B=0.4I_{3\times 3}, Di=0.025I1×3D_{i}=0.025I_{1\times 3} and Fij=0.5I3×3F_{ij}=0.5I_{3\times 3}. The measure of confidence in the neighbouring estimates is set to be Zij=0.1I3×3Z_{ij}=0.1I_{3\times 3}. The initial values for the Riccati differential equations (18) are chosen to be Ki(0)=10I3×3K_{i}(0)=10I_{3\times 3} and the matrix M1M^{-1} is chosen by solving (30) with the disturbance attenuation weighting matrix P=12(+)IP=\frac{1}{2}(\mathcal{L}+\mathcal{L}_{\top})\otimes I (to ensure (30) holds strictly, in fact we solved (30) with P=12(+)I+0.01IP=\frac{1}{2}(\mathcal{L}+\mathcal{L}_{\top})\otimes I+0.01I). According to Theorem 2, this guarantees the satisfaction of the conditions of Theorem 1. Furthermore, with this choice of matrix PP, the proposed minimum energy filter guarantees that estimation error dynamics are internally stable and exhibit the HH_{\infty} performance expressed in condition (25).

To illustrate performance of the filters, they are simulated using MATLAB. The simulation was implemented with the maximum step size of 0.0010.001 seconds and simulation time of 1010 seconds. The system disturbances are modeled as pulse signals of appropriate dimensions that last for 11 seconds. The initial state is drawn from a normally distributed vectors with mean of 0.10.1 and standard deviation 0.20.2. Figure 1 shows the plot of the estimation error of the first coordinate of each filter, x^i1(t)x1(t)\hat{x}^{1}_{i}(t)-x^{1}(t). The plots confirm that despite some of local filters alone lead to an undetectable estimation problem, the proposed distributed filter has successfully utilized imperfect communications between the nodes to provide estimates at each node with estimation errors converging to zero.

Refer to caption
Figure 1: The estimation errors of the 55 filters in their first coordinates.

VII CONCLUSIONS

In this paper we proposed a distributed filtering algorithm by utilizing an HH_{\infty} minimum-energy filtering approach. The algorithm employs a decoupled computation of the individual filter coefficients. This is achieved by considering the estimation error of neighbouring agents as additional exogenous disturbances weighted according to the nodes’ confidence in their neighbours’ estimates. The proposed algorithm is shown to provide guaranteed internal stability and desired disturbance attenuation of the network error dynamics. The paper has discussed tuning of the algorithm. We have also provided a simulation example that confirms convergence of the proposed algorithm in the case a Chua circuit with undetectable pairs (A,Ci)(A,C_{i}) at some of the nodes.

References

  • [1] H. F. Durrant-Whyte, B. Rao, and H. Hu, “Toward a fully decentralized architecture for multi-sensor data fusion,” in Robotics and Automation, 1990. Proceedings., 1990 IEEE International Conference on. IEEE, 1990, pp. 1331–1336.
  • [2] B. Rao, H. Durrant-Whyte, and J. Sheen, “A fully decentralized multi-sensor system for tracking and surveillance,” The International Journal of Robotics Research, vol. 12, no. 1, pp. 20–44, 1993.
  • [3] R. Olfati-Saber, “Distributed kalman filter with embedded consensus filters,” in Decision and Control, 2005 and 2005 European Control Conference. CDC-ECC’05. 44th IEEE Conference on. IEEE, 2005, pp. 8179–8184.
  • [4] V. Ugrinovskii, “Distributed robust filtering with h-infinity consensus of estimates,” Automatica, vol. 47, no. 1, pp. 1–13, 2011.
  • [5] M. V. Subbotin and R. S. Smith, “Design of distributed decentralized estimators for formations with fixed and stochastic communication topologies,” Automatica, vol. 45, no. 11, pp. 2491 – 2501, 2009.
  • [6] B. D. O. Anderson and J. Moore, Optimal filtering. Prentice Hall, 1979.
  • [7] V. Ugrinovskii, “Distributed robust estimation over randomly switching networks using consensus,” Automatica, vol. 49, no. 1, pp. 160 – 168, 2013.
  • [8] R. E. Mortensen, “Maximum-likelihood recursive nonlinear filtering,” Journal of Optimization Theory and Applications, vol. 2, no. 6, pp. 386–394, 1968.
  • [9] O. B. Hijab, “Minimum energy estimation,” Ph.D. dissertation, University of California, Berkeley, 1980.
  • [10] M. Athans and P. Falb, Optimal control: an introduction to the theory and its applications. McGraw-Hill, 1966.
  • [11] V. Ugrinovskii, “Conditions for detectability in distributed consensus-based observer networks,” IEEE Tran. Autom. Contr., vol. 58, pp. 2659 – 2664, 2013, arXiv:1303.6397[cs.SY].
  • [12] W. M. McEneaney, “Robust HH_{\infty} filtering for nonlinear systems,” Systems & control letters, vol. 33, no. 5, pp. 315–325, 1998.
  • [13] T. Başar and P. Bernhard, H [infinity symbol]-optimal control and related minimax design problems: A dynamic game approach. Birkhčauser (Boston), 1995.