Abstract

We address a state estimation problem over a large-scale sensor network with uncertain communication channel. Consensus protocol is usually used to adapt a large-scale sensor network. However, when certain parts of communication channels are broken down, the accuracy performance is seriously degraded. Specifically, outliers in the channel or temporal disconnection are avoided via proposed method for the practical implementation of the distributed estimation over large-scale sensor networks. We handle this practical challenge by using adaptive channel status estimator and robust L1-norm Kalman filter in design of the processor of the individual sensor node. Then, they are incorporated into the consensus algorithm in order to achieve the robust distributed state estimation. The robust property of the proposed algorithm enables the sensor network to selectively weight sensors of normal conditions so that the filter can be practically useful.

1. Introduction

The estimation problem for a multisensor environment has been investigated for two decades [1–5]. Mainly two schemes are discussed to design the system: centralized fusion and distributed fusion.

Centralized fusion is a fusion architecture composed of one fusion center linked with multiple sensors. This architecture does not require a particular fusion rule; instead observations from multiple sensors are stacked as one sensor measurement whose size is very large. It is relatively easy to implement; however, communication bottle neck problems, sensor scheduling, and lack of flexibility are known as disadvantages [1]. Furthermore, if some communication channels between the central processor and sensor node are uncertain, it is difficult to manage in an adaptive manner.

On the other hand, decentralized fusion has been studied in the literature to tackle disadvantages of the centralized fusion [1]. Initial study of decentralized fusion is known as a decentralized Kalman filter in [2] which is mathematically equivalent to the centralized one. However, its usage is restricted only when sensor nodes are fully connected each other [2]. Namely, only one kind of network topology is allowed (e.g., all-to-all communication).

Based on this observation, the distributed fusion algorithm is suggested to consider issues in the practical implementation of the networked system [6]. For instance, the distributed fusion is required to resolve a network topology, measurement outliers, that is, sensor failure and limited communication bandwidth.

The network topology in multiagent systems has been actively investigated in control community and applied in the sensor network [3]. It was assumed that the network has fixed topology when sensor nodes are geometrically distributed and all communication channels operate in normal.

In parallel, regarding uncertain communication channel, single Kalman filter with intermittent observation gets explosive attentions in the network control system applications [4, 5]. The main direction of conducted research was the stability analysis of the system under uncertain communication channels [4]. In this case, it is assumed that the communication channel uses TCP-like protocol that means that a packet is dropped based on its acknowledgement. Afterwards it has been extended for multisensor network systems [5]. The authors proposed the estimation algorithm using a sequential Kalman filtering using a set of recent observations collected from adjacent linked nodes. A tree topology is exploited for each node to understand the network topology of limited sensing range.

In another type of applications, however, we may not know the acknowledgement of the packet when the channel link between sensors is not reliable or changed due to the evolution of the network topology. For instance, mobile robots may change their topology based on the agents’ location or there exit temporal disconnections in channels. In such cases, the packet arrival event should be estimated.

Previous research in data fusion and intermittent observation problem basically assumes that the noise statistic is known a priori, for example, Gaussian or bounded [4, 5, 7]. However, this assumption is often violated when outlier measurement happens.

The outlier can be originated from several practical challenges such as sensor failures, measurement outliers, or even intentional jamming. To solve this problem robust statistics has been investigated, for example, M-estimator [8]. L1-norm optimization was also considered as a solution because it is common that L1-norm optimization is robust against the outlier noise compared to the L2-norm optimization (e.g., Kalman filter). However, the use of L1-norm is overlooked due to the computational complexity. With the help of advances in real-time convex optimization, L1-norm optimization is recently revisited and its application is rigorously investigated [9].

In this paper, we consider the estimation problem under multisensor environment with uncertain communication channels. Main tasks to solve this problem are (1) estimation of the channel status, (2) robust estimation to avoid outliers and uncertainty in communication channels, and (3) measurement fusion algorithm regarding to (1) and (2). The proposed work has a two-stage framework, that is, channel status estimation and L1-norm optimization-based outlier rejection. Note that to the author’s knowledge there is no intensive research in the model-based state estimation problem (e.g., Kalman filtering) considering communication channel uncertainty over a large-scale sensor network.

The remainder of the paper is organized as follows. Section 2 describes the problem formulation and the Kalman-consensus filter is introduced as a basic framework. Proposed algorithm is subsequently explained in Section 3 including channel status estimation, sparse optimization via L1-norm optimization, and the modified robust Kalman-consensus filter as an overall algorithm. A test example is provided to demonstrate the efficacy of the proposed algorithm in Section 4. Then, conclusion is made in Section 5.

2. Problem Statement and Kalman-Consensus Filter

2.1. Problem Statement

Consider a time-invariant linear system with Jump Markov measurement model asπ‘₯𝑑+1=𝐴π‘₯𝑑+𝑀𝑑,𝑦𝑖𝑑𝛾=𝐢𝑖𝑑π‘₯𝑑+πœπ‘–π‘‘+𝑧𝑖𝑑,𝑖=1,…,𝑀,(2.1) where π‘₯π‘‘βˆˆβ„œπ‘› is the state (to be estimated) and π‘¦π‘–π‘‘βˆˆβ„œπ‘š is the 𝑖th measurement of a node in the network at time 𝑑, respectively. π΄βˆˆβ„œπ‘›Γ—π‘› is the system matrix, and 𝐢(𝛾𝑖𝑑)βˆˆβ„œπ‘šΓ—π‘› is the 𝑖th measurement matrix of the node governed by a random latent variable 𝛾𝑖𝑑 which describes the measurement mode 𝛾𝑖𝑑=1 for packet received; 𝛾𝑖𝑑=0, otherwise. π‘€π‘‘βˆˆβ„œπ‘›, πœπ‘–π‘‘βˆˆβ„œπ‘š and π‘§π‘–π‘‘βˆˆβ„œπ‘š; are system noise, measurement noise, and sparse noise in the measurement, respectively. The sparse noise term 𝑧𝑖𝑑 models the outlier measurements whose magnitude is considerably large compared to the observation noise; thus it cannot be modeled as the standard Gaussian distribution. The process noise 𝑀𝑑 is independent identically distributed (i.i.d.) 𝑁(0,𝑄) and the measurement noise πœπ‘–π‘‘ is i.i.d. 𝑁(0,𝑅𝑖). Assume that the initial state π‘₯0, the process noise, and the measurement noise are mutually uncorrelated each other.

Then, the main goal is to estimate the state π‘₯0 given measurements from 𝑀 sensors up to time 𝑑, that is, π‘Œπ‘‘={𝑦11βˆΆπ‘‘,…,𝑦𝑀1βˆΆπ‘‘} where 𝑦𝑖1βˆΆπ‘‘={𝑦𝑖1,…,𝑦𝑖𝑑}.

2.2. Kalman-Consensus Filter

In a large-scale sensor network, it is practically impossible that all the sensor nodes are fully connected each other. Therefore, there should be data fusion algorithm to adaptively aggregate sensor nodes into a globally reasonable estimate. In this study, we adopt a data fusion algorithm using a consensus protocol combined with Kalman filters of each node, called Kalman-consensus filter (KCF) [3]. Using a simple average consensus, individual decentralized Kalman filter called micro-Kalman filter communicates information with its neighbors and the state estimate. The flow of the information over the whole network is possible due to the graph Laplacian of the network topology. As illustrated in [3], even though the target state is partially observed with different groups of sensors and there is no fusion center, individual nodes agree with the converged estimate of the state.

Compared to other data fusion algorithms, KCF has advantages when error-cross covariance information is not available for pairs of sensor node. In addition, because the sensor network topology is incorporated in the data fusion algorithm, local information is propagated all over the network.

In KCF framework, the communication topology between sensor nodes is represented by the directed graph 𝐺=(𝑉,𝐸), where 𝑉={1,2,…,𝑀} denotes the sensor node set. The edge set πΈβŠ‚π‘‰Γ—π‘‰ describes the communication links between each pair of nodes. The neighbor of sensor node 𝑖 is defined as πΏπ‘–βˆΆπ½π‘–=𝐿𝑖βˆͺ{𝑖}. KCF is implemented based on the information from of Kalman filter for each node and the consensus protocol to approach the global estimate as follows.

Assume that the latent variable 𝛾𝑖𝑑 is known. The estimation of the latent variable will be given in following section. Then, contribution terms of the information Kalman filter are calculated for each node as follows:𝑒𝑖𝑑=ξ€·πΆξ€·π›Ύπ‘–π‘‘ξ€Έξ€Έπ‘‡ξ€·π‘…π‘–ξ€Έβˆ’1𝑦𝑖𝑑,π‘ˆπ‘–π‘‘=ξ€·πΆξ€·π›Ύπ‘–π‘‘ξ€Έξ€Έπ‘‡ξ€·π‘…π‘–ξ€Έβˆ’1𝐢𝛾𝑖𝑑.(2.2) Based on the known communication topology 𝐺, each node broadcasts its message π‘šπ‘–π‘‘=(𝑒𝑖𝑑,π‘ˆπ‘–π‘‘,π‘₯𝑖𝑑), where π‘₯𝑖𝑑 is the priori state estimate of the sensor node 𝑖 and collects message π‘šπ‘Ÿπ‘‘=(π‘’π‘Ÿπ‘‘,π‘ˆπ‘Ÿπ‘‘,π‘₯π‘Ÿπ‘‘) from its neighbors. Then, all the contribution terms are aggregated as 𝑔𝑖𝑑=βˆ‘π‘Ÿβˆˆπ½π‘–π‘’π‘Ÿπ‘‘,𝑆𝑖𝑑=βˆ‘π‘Ÿβˆˆπ½π‘–π‘ˆπ‘Ÿπ‘‘.

With the aggregated contribution terms, each node calculates Kalman-consensus estimate using update step and prediction step as follows.

Update:𝑀𝑖𝑑=ξ‚€ξ€·π‘ƒπ‘–π‘‘ξ€Έβˆ’1+π‘†π‘–π‘‘ξ‚βˆ’1,Μ‚π‘₯𝑖𝑑+1=π‘₯𝑖𝑑+π‘€π‘–π‘‘ξ‚€π‘”π‘–π‘‘βˆ’π‘†π‘–π‘‘π‘₯𝑖𝑑𝑀+πœ€π‘–π‘‘β€–β€–π‘€1+π‘–π‘‘β€–β€–ξ“π‘Ÿβˆˆπ½π‘–ξ‚€π‘₯π‘Ÿπ‘‘βˆ’π‘₯𝑖𝑑.(2.3)

Prediction:𝑃𝑖𝑑+1βŸ΅π΄π‘‘π‘€π‘–π‘‘π΄π‘‡π‘‘+𝑄,π‘₯𝑖𝑑+1βŸ΅π΄π‘‘Μ‚π‘₯𝑖𝑑+1,(2.4) where πœ€ is the discretization step size and β€–β‹…β€– denotes the matrix norm.

KCF is easy to implement compared to other data fusion algorithms and scalable for large-scale networks [3]. However, it is assumed that the communication channel links are operating in normal which is often not the case in practical situations. When the topology has been changed, channel links are disconnected, or corrupted with outlier measurements, the performance of the consensus algorithm is not reliable anymore.

In this technical note, we propose the robust multisensor consensus estimator to avoid uncertainties in channel of the sensor network. We require three strategies to solve this problem: (1) channel status estimation, that is, mode estimation, (2) outlier rejection, and (3) data fusion. In the following section, we propose the robust Kalman-Consensus Filter based on the channel mode estimation, sparse optimization using L1-norm.

3. Main Results

3.1. Robust Kalman Filtering Using L1-Norm Optimization

Kalman filter is known as an optimal estimator in linear Gaussian system. However, when the linear Gaussian assumption is violated in practice, additional modification is necessary. Because the outlier measurement is not able to be modeled as Gaussian, we model the outlier measurement as 𝑧𝑖𝑑 which is sparse. To alleviate the additional sparse noise, we adopt the robust Kalman filtering via sparse optimization using L1-norm in [9].

The standard Kalman filtering without the sparse noise is given as follows.

Prediction:Μ‚π‘₯π‘–π‘‘βˆ£π‘‘βˆ’1=𝐴̂π‘₯π‘–π‘‘βˆ’1βˆ£π‘‘βˆ’1.(3.1)

Update:Μ‚π‘₯π‘–π‘‘βˆ£π‘‘=Μ‚π‘₯π‘–π‘‘βˆ£π‘‘βˆ’1+Ξ¦π‘–π‘‘βˆ£π‘‘ξ€·πΆπ‘–ξ€Έπ‘‡ξ‚€πΆπ‘–Ξ¦π‘–π‘‘βˆ£π‘‘ξ€·πΆπ‘–ξ€Έπ‘‡+π‘…π‘–ξ‚βˆ’1ξ‚€π‘¦π‘–π‘‘βˆ’πΆπ‘–Μ‚π‘₯π‘–π‘‘βˆ£π‘‘βˆ’1,(3.2) where Ξ¦π‘–π‘‘βˆ£π‘‘ is the state error covariance. Here, we assume that the channel mode is completely known, that is, 𝐢(𝛾𝑖𝑑)β‰œπΆπ‘–π‘‘. In the least square problem, Kalman filter is to minimize the cost function defined as ξ€·πœπ‘–π‘‘ξ€Έπ‘‡ξ€·π‘…π‘–ξ€Έβˆ’1πœπ‘–π‘‘+ξ‚€π‘₯π‘‘βˆ’Μ‚π‘₯π‘–π‘‘βˆ£π‘‘βˆ’1ξ‚π‘‡ξ‚€Ξ¦π‘–π‘‘βˆ£π‘‘ξ‚βˆ’1ξ‚€π‘₯π‘‘βˆ’Μ‚π‘₯π‘–π‘‘βˆ£π‘‘βˆ’1(3.3) subject to 𝑦𝑖𝑑=𝐢𝑖𝑑π‘₯𝑑+𝑣𝑖𝑑. The cost function of (3.1) is modified by adding regularization term considering the sparse noise 𝑧𝑖𝑑 asξ€·πœπ‘–π‘‘ξ€Έπ‘‡ξ€·π‘…π‘–ξ€Έβˆ’1πœπ‘–π‘‘+ξ‚€π‘₯π‘‘βˆ’Μ‚π‘₯π‘–π‘‘βˆ£π‘‘βˆ’1ξ‚π‘‡ξ‚€Ξ¦π‘–π‘‘βˆ£π‘‘ξ‚βˆ’1ξ‚€π‘₯π‘‘βˆ’Μ‚π‘₯π‘–π‘‘βˆ£π‘‘βˆ’1‖‖𝑧+πœ†π‘–π‘‘β€–β€–1(3.4) subject to 𝑦𝑖𝑑=𝐢𝑖𝑑π‘₯𝑑+πœπ‘–π‘‘+𝑧𝑖𝑑. The minimization problem is solved using convex optimization. πœ† is the regularization parameter.

The cost function of (3.4) is rewritten using residual 𝑒𝑖𝑑=π‘¦π‘–π‘‘βˆ’πΆπ‘–π‘‘Μ‚π‘₯π‘–π‘‘βˆ£π‘‘βˆ’1 as𝑒𝐽=π‘–π‘‘βˆ’π‘§π‘–π‘‘ξ€Έπ‘‡π‘Šξ€·π‘’π‘–π‘‘βˆ’π‘§π‘–π‘‘ξ€Έβ€–β€–π‘§+πœ†π‘–π‘‘β€–β€–1(3.5) where π‘Š=(πΌβˆ’πΆπ‘–πΎπ‘–π‘‘)𝑇(𝑅𝑖)βˆ’1(πΌβˆ’πΆπ‘–πΎπ‘–π‘‘)+(𝐾𝑖𝑑)𝑇(Ξ¦π‘–π‘‘βˆ£π‘‘)βˆ’1𝐾𝑖𝑑, 𝐼 is the identity matrix of appropriate dimension, and 𝐾𝑖𝑑=Ξ¦π‘–π‘‘βˆ£π‘‘(𝐢𝑖𝑑)𝑇(πΆπ‘–π‘‘Ξ¦π‘–π‘‘βˆ£π‘‘(𝐢𝑖𝑑)𝑇+𝑅𝑖)βˆ’1 is the Kalman gain. We solve the minimization of the cost function defined in (3.5) for the sparse noise as follows:̂𝑧𝑖𝑑=argmin𝐽.𝑧𝑖𝑑(3.6) Then the Kalman filter estimate is represented byΜ‚π‘₯π‘–π‘‘βˆ£π‘‘=Μ‚π‘₯π‘–π‘‘βˆ£π‘‘βˆ’1+πΎπ‘–π‘‘ξ€·π‘’π‘–π‘‘βˆ’Μ‚π‘§π‘–π‘‘ξ€Έ.(3.7) Unlike the implementation in [9], our goal is to estimate the sparse noises and reject them from the measurements for the channel mode estimation in the next stage.

3.2. Channel Mode Estimation

Motivated by the work [10, 11], we try to estimate the channel mode 𝛾𝑑 using moving horizon strategy. We denote the channel mode for the sensor node 𝑖 as 𝛾𝑖𝑑 which is the discrete random variable. Assume that the evolution of the channel mode has the first-order Markov chain, its transition probability πœ‹1,1 is the probability that the packet will arrive between time steps, and conversely πœ‹0,1 represents the probability that the channel is switched off between time steps. Then, Bayesian update of the channel mode probability, that is, Pr(π›Ύπ‘–π‘ βˆ£π‘¦π‘–π‘ βˆ’1) in the moving horizon [π‘‘βˆ’Ξ”,𝑑] is provided as follows.

For each measurement mode, 𝑙=1→𝛾𝑖𝑑=1,and𝑙=0→𝛾𝑖𝑑=0.

Prediction:𝛾Prπ‘–π‘ βˆ£π‘¦π‘–π‘ βˆ’1ξ€Έ=πœ‹1,1𝛾Prπ‘–π‘ βˆ’1βˆ£π‘¦π‘–π‘ βˆ’1ξ€Έ+πœ‹0,1𝛾1βˆ’Prπ‘–π‘ βˆ’1βˆ£π‘¦π‘–π‘ βˆ’1ξ€Έξ€Έ(3.8)

Update:𝛾Prπ‘–π‘ βˆ£π‘¦π‘–π‘ ξ€Έ=Λ𝑖𝑠𝛾Prπ‘–π‘ βˆ£π‘¦π‘–π‘ βˆ’1ξ€Έξ€·1βˆ’1βˆ’Ξ›π‘–π‘ ξ€Έξ€·π›ΎPrπ‘–π‘ βˆ£π‘¦π‘–π‘ βˆ’1ξ€Έ,𝑠=π‘‘βˆ’Ξ”,…,𝑑,(3.9) where the measurement likelihood of sensor node 𝑖 at time 𝑠 is defined as Ξ›π‘–π‘ β‰œπ‘¦π‘–π‘ βˆ’πΆ(𝛾𝑖𝑠)Μ‚π‘₯𝑖𝑠|π‘ βˆ’1 and Μ‚π‘₯𝑖𝑠|π‘ βˆ’1 is the predicted state of local Kalman filter given in (3.1). Note that the recursion given in (3.8)-(3.9) is iterated in moving horizon [π‘‘βˆ’Ξ”,𝑑] to obtain the channel mode estimate as ̂𝛾𝑖𝑑=1, if Pr(𝛾𝑖𝑑|𝑦𝑖𝑑)>π‘‡β„Žπ‘Ÿπ‘’π‘ β„Žπ‘œπ‘™π‘‘1, or ̂𝛾𝑖𝑑=0, if Pr(𝛾𝑖𝑑|𝑦𝑖𝑑)<π‘‡β„Žπ‘Ÿπ‘’π‘ β„Žπ‘œπ‘™π‘‘0. In the channel mode probability calculation, we assume that the channel modes is not switched to other mode again at least within 𝛼 steps. It is similar to the mode observability assumption given in [10]. Compared to the given assumption in [10], our assumption is not strict because we are not trying to distinguish the sequence of the mode in the horizon but to obtain the stable estimate of the current mode.

3.3. Overall Algorithm

In previous subsections we have discussed about robust Kalman filtering via L1-norm optimization and the channel mode estimation based on the channel mode probability. In this subsection, we combine two methods and suggest a robust data fusion algorithm to construct the overall implementation of our algorithm.

The overall flow of the proposed algorithm is displayed in Figure 1. The dynamic state process is observed from multisensors. To efficiently reject the sparse measurement outliers, L1-norm optimization is subsequently utilized. After trimming multiple measurements by rejection of outliers, we estimate the channel mode of each sensor node and finally fuse the set of estimate and measurement based on the consensus protocol which is explained in (2.2)–(2.4). According to the overall flow of the proposed algorithm described in Figure 1, we summarize the robust distributed fusion consensus filter in Algorithm 1.

Given βˆ‘ 𝑖 𝑑 | 𝑑 βˆ’ 1 , error covariance, Μ‚ π‘₯ 𝑖 𝑑 | 𝑑 βˆ’ 1 , previous estimate, consensus
update parameter πœ€ , and the window size Ξ” .
 1. Obtain measurement 𝑦 𝑖 𝑑 = 𝐢 ( 𝛾 𝑖 𝑑 ) π‘₯ 𝑑 + 𝜐 𝑖 𝑑 + 𝑧 𝑖 𝑑 , 𝑖 = 1 , … , 𝑁 .
 2. For each measurement solve L1-norm optimization problem,
   reject outliers as given in (3.5) and then obtain the trimmed
   measurements: Μ‚ 𝑦 𝑖 𝑑 = 𝑦 𝑖 𝑑 βˆ’ Μ‚ 𝑧 𝑖 𝑑 .
 3. Calculate the mode probability P r ( 𝛾 𝑖 𝑑 ∣ Μ‚ 𝑦 𝑖 𝑑 βˆ’ Ξ” ∢ 𝑑 ) .
   Given P r ( 𝛾 𝑖 𝑑 βˆ’ Ξ” ∣ Μ‚ 𝑦 𝑖 𝑑 βˆ’ Ξ” ) ,
   For 𝑠 = 𝑑 βˆ’ Ξ” ∢ 𝑑
    Evaluate measurement likelihood for Μ‚ 𝑦 𝑖 𝑠 .
    Evaluate the Bayesian recursion (3.8)-(3.9).
   End
   Decide the channel mode Μ‚ 𝛾 𝑖 𝑑 using threshold testing.
 4. Compute contribution term of information state and matrix
   such that
           𝑒 𝑖 𝑑 = ( 𝐢 𝑖 𝑑 ( Μ‚ 𝛾 𝑖 𝑑 ) ) 𝑇 ( 𝑅 𝑖 ) βˆ’ 1 Μ‚ 𝑦 𝑖 𝑑 ,
          π‘ˆ 𝑖 𝑑 = ( 𝐢 𝑖 𝑑 ( Μ‚ 𝛾 𝑖 𝑑 ) ) 𝑇 ( 𝑅 𝑖 ) βˆ’ 1 𝐢 𝑖 𝑑 ( Μ‚ 𝛾 𝑖 𝑑 ) .
 5. Broadcast message π‘š 𝑖 𝑑 = ( 𝑒 𝑖 𝑑 , π‘ˆ 𝑖 𝑑 , Μ‚ π‘₯ 𝑖 𝑑 | 𝑑 βˆ’ 1 ) to neighbors in 𝐿 𝑖 .
 6. Collect messages π‘š π‘Ÿ 𝑑 = ( 𝑒 π‘Ÿ 𝑑 , π‘ˆ π‘Ÿ 𝑑 , Μ‚ π‘₯ π‘Ÿ 𝑑 | 𝑑 βˆ’ 1 ) from neighbors.
 7. Aggregate the information states and matrices of neighbors
   including node 𝑖 : 𝐽 𝑖 = 𝐿 𝑖 βˆͺ { 𝑖 } :
          𝑔 𝑖 𝑑 = βˆ‘ π‘Ÿ ∈ 𝐽 𝑖 𝑒 π‘Ÿ 𝑑 , 𝑆 𝑖 𝑑 = βˆ‘ π‘Ÿ ∈ 𝐽 𝑖 π‘ˆ π‘Ÿ 𝑑 .
 8. Compute the Kalman-Consensus estimate:
           ( 𝑀 𝑖 𝑑 ) βˆ’ 1 = ( Ξ¦ 𝑖 𝑑 ∣ 𝑑 βˆ’ 1 ) βˆ’ 1 + 𝑆 𝑖 𝑑 ,
  Μ‚ π‘₯ 𝑖 𝑑 ∣ 𝑑 = Μ‚ π‘₯ 𝑖 𝑑 ∣ 𝑑 βˆ’ 1 + 𝑀 𝑖 𝑑 ( 𝑔 𝑖 𝑑 βˆ’ 𝑆 𝑖 𝑑 Μ‚ π‘₯ 𝑖 𝑑 | 𝑑 βˆ’ 1 𝑀 ) + πœ€ 𝑖 𝑑 1 + β€– 𝑀 𝑖 𝑑 β€– βˆ‘ π‘Ÿ ∈ 𝐽 𝑖 ( Μ‚ π‘₯ π‘Ÿ 𝑑 ∣ 𝑑 βˆ’ 1 βˆ’ Μ‚ π‘₯ 𝑖 𝑑 ∣ 𝑑 βˆ’ 1 ) .
   Prediction stage
Ξ¦ 𝑖 𝑑 + 1 ∣ 𝑑 ⟡ 𝐴 𝑀 𝑖 𝑑 𝐴 𝑇 + 𝑄 ,
           Μ‚ π‘₯ 𝑖 𝑑 + 1 ∣ 𝑑 ⟡ 𝐴 Μ‚ π‘₯ 𝑖 𝑑 ∣ 𝑑 .

Remark 3.1. Consider that error convergence of the algorithm L1-norm optimization and measurement mode estimation are main concerns. When we modified Kalman filtering update step with L1-norm optimization then, it is not Gaussian estimate anymore. So, it is not straightforward to readily analyze the error convergence in modified Kalman filtering. Therefore, it is remained as a future work for ours.

Remark 3.2. Considering the measurement mode observability, we follow the idea similar to [10] that there is a minimum dwell time of the measurement mode switching. Thus, we set the horizon window size Ξ” as the minimum dwell time of the measurement mode switching. In practice, this value is the design parameter for the network. However, the value of the delta is not that sensitive to the minimum dwell time of the channel, that is, tuning of the delta is not that sensitive. In addition, in cases where frequent switching happens, we regard it as outlier measurement and it will be handled via robust Kalman filtering step in L1-norm optimization.

Remark 3.3. In the experiment, we set the horizon size as 5 when the switching probability is πœ‹1,0=πœ‹0,1=0.05. In our experiment, if the mode is switched within 𝜏 step which is less than the predefined horizon size Ξ”, then the performance of the channel mode estimator is not reliable. Thus, as already explained in Remark 3.1, frequent switching would be considered as permanent channel link break down. However, rather fast but not abnormally frequent switching can be handled via switching Kalman filters (e.g. interacting multiple model filter (IMM filter)).

4. Illustrative Example

In this section, we test the efficacy of the proposed algorithm with the state estimation problem using a large-scale sensor network.

Given the target dynamics of a circular movement [3]π‘₯𝑑+1=𝐴π‘₯𝑑+𝐡𝑀𝑑,(4.1) where 𝐴0ξ€Ί=20βˆ’110ξ€», 𝐡0=52𝐼2, 𝐴=𝐼2+πœ€π΄0+(πœ€2/2)𝐴20+(πœ€2/6)𝐴30, and 𝐡=πœ€π΅0. In addition, 𝐼2 is a 2 Γ— 2 identity matrix which is a discretized model with a step size πœ€=0.015, and the initial position and uncertainty are π‘₯0=(15,βˆ’10)𝑇 and 𝑃0=10𝐼2, respectively. A moving target having a circular motion can then be observed via the large-scale sensor network of 100 sensor nodes as displayed in Figure 2. Here, the sensor nodes measure the target position with uncertain communication channel links between nodes as𝑦𝑖𝑑𝛾=𝐢𝑖𝑑π‘₯𝑑+πœπ‘–π‘‘,𝑑=0,1,…,𝑖=1,…,100,(4.2) where either𝐢𝛾𝑖𝑑=ξƒ―ξ€Ίξ€»10,if𝛾𝑖𝑑=1,00,if𝛾𝑖𝑑𝛾=0,or𝐢𝑖𝑑=ξƒ―ξ€Ίξ€»01,if𝛾𝑖𝑑=1,00,if𝛾𝑖𝑑=0.(4.3) In the observation model, individual sensor measures either π‘₯-position or 𝑦-position. For each sensor node we model the channel mode latent variable 𝛾𝑖𝑑 that describes the channel condition. To simulate the true observation mode for each node, the mode switch in the communication channel link is modeled as Pr(𝛾𝑖𝑑=0)≑Pr(𝑒(0,1)<0.01), where 𝑒(0,1) is a uniform random distribution. We also model the evolution of channel mode variable as the first-order Markov chain. In this case, the transition probability between modes is given a priori. The observation noise for each sensor is white Gaussian noise with πœπ‘–π‘‘βˆΌπ‘(0,302βˆšπ‘–). In addition, sparse noises are generated with the probability 0.05, whose magnitude is 10 times larger than that of the measurement noise.

4.1. Comparison with KCF

In the experiment we compare our proposed algorithm with standard KCF. Figure 3 simply and clearly demonstrates that our algorithm is robust when there are practical challenges in the network.

To show more clearly the robustness against the outliers, we select one sensor node experiment. That is because in KCF framework, certain amount of uncertainty can be aggregated via consensus update. The comparison of estimated trajectory with the ground truth is given in Figure 4. Measurements are also displayed with outliers to show that the proposed estimation in sensor node considerably improved mean square error (MSE) as illustrated in Figure 5.

4.2. Comparison with Switching Kalman Filter

As mentioned in Remark 3.3, rather fast switching of the channel mode can be handled more accurately via the IMM filter that is known as switching Kalman filter [12]. From our experiments, the proposed method (i.e., observation mode estimation via moving horizon strategy) is more accurate when the actual switching of the channel occurs in more than Ξ” steps. It means that the moving horizon strategy guarantees us the stable estimate of the observation mode when the minimum dwell time assumption is held as described in Section 3.2. On the other hand, the IMM filter shows us slightly increased errors in this case because the IMM does not determine the exact mode as 1 or 0. Instead, the mode probability is calculated and utilized for weighted averaging. However, the IMM filter is more robust in cases where mode switching frequently occurs. That is because there is no minimum dwell time assumption in the IMM filter.

In terms of computational complexity, the IMM filter is implemented using two parallel Kalman filters for each observation mode, that is, the complexity is approximately 𝑂(2𝑛2|𝐸|+𝑛2𝑁), where 𝑛 is the dimension of the state, 𝑁 is the number of nodes, and |𝐸| is the number of edge (e.g., links) in the network, as already mentioned in Section 2. In contrast, the proposed algorithm requires a recursion for mode estimation within a horizon window; thus, the complexity is approximated as 𝑂(𝑛Δ|𝐸|+𝑛2𝑁). Therefore, the proposed algorithm is less complex than the IMM algorithm. Note that the complexity of the Kalman filter is 𝑂(𝑛2).

5. Conclusion

In this paper we propose a novel distributed data fusion algorithm that is robust against outlier measurements and channel uncertainty. Outliers are rejected from the L1-norm optimization algorithm and the channel uncertainty is reduced using the measurement mode estimation algorithm. For the implementation in a large-scale sensor network, we adopt the KCF framework and test the framework with an object state estimation problem. Results successfully demonstrate that the proposed framework is able to handle practical challenges.

Acknowledgments

This work was supported in part by GIST Systems Biology Infrastructure Establishment Grant by the Center for Distributed Sensor Network at GIST and by the Unmanned Technology Research Center at KAIST, originally funded by DAPA, ADD, and Republic of Korea.