Adaptive Finite-Horizon Group Estimation for Networked Navigation Systems with Remote Sensing Complementary Observations under Mixed LOS / NLOS Environments

Networked navigation system (NNS) enables a wealth of new applications where real-time estimation is essential. In this paper, an adaptive horizon estimator has been addressed to solve the navigational state estimation problem of NNS with the features of remote sensing complementary observations (RSOs) andmixed LOS/NLOS environments. In our approach, it is assumed that RSOs are the essential observations of the local processor but suffer from random transmission delay; a jump Markov system has been modeled with the switching parameters corresponding to LOS/NLOS errors. An adaptive finite-horizon group estimator (AFGE) has been proposed, where the horizon size can be adjusted in real time according to stochastic parameters and random delays. First, a delay-aware FIR (DFIR) estimator has been derived with observation reorganization and complementary fusion strategies. Second, an adaptive horizon group (AHG) policy has been proposed to manage the horizon size. The AFGE algorithm is thus realized by combining AHG policy and DFIR estimator. It is shown by a numerical example that the proposed AFGE has a more robust performance than the FIR estimator using constant optimal horizon size.


Introduction
Networked navigation system (NNS) [1,2], which determines its navigational state individually from the cooperative information taken with respect to spatial neighbors, has been used for a variety of purposes, such as cooperative localization [3], multivehicle cooperative guidance [4], and spatially distributed estimation [5].NNS typically takes advantage of state estimations for accurate localization essentially based on the remote sensing observations (RSOs), which is transmitted by the cooperative NNSs through a wireless medium.Thus, during the design of navigational state estimator, several problematic issues in NNS should be considered, induced by the observation features and the transmission environment.In this research, the impact of mixed LOS/NLOS environment and complementary feature of RSOs will be investigated.
Remote sensing observations (RSOs), such as image, relative measurement, and sink knowledge, always have complementary feature, which means every observed data just comprises partial of system dynamics; thus one useful observation of estimator can only be obtained by the integration of multiple synchronous RSOs.Note that these RSOs are ubiquitous in large-scale systems [6], especially in wireless networked system (WNS) [7], and thus the state estimation based on the sensors of RSO data is brought forward.In [8], a particle filter based track-before-detect (TkBD) scheme was proposed for multiple sensors, where the sensors were asynchronous and heterogeneous; however, the TkBD schemes are computationally expensive and are mainly applicable in scene of low signal-to-noise ratios.Earlier research of RSO focused on optical sensors [9], in which the sensor noise is assumed to be Gaussian.More recent efforts focus on the radar problem, where the pixel intensity is either Rayleigh or Rician distributed depending on the absence or presence of objectives [10].Although the extant literature considers various types of RSO sensors, the researches on the complementary property of wireless networks are quite few, let alone the packet-based RSO of NNS, that is, the navigational knowledge of the sender and the relative measurements.
Non-line-of-sight (NLOS) propagation might take place in a wireless network whenever there are obstacles hindering the radio signal path between the objective and its cooperative neighbors, especially in an urban region or the indoor environment.Whenever measured by received signal strength (RSS) or angle of arrival (AOA), NLOS propagation often induces transmission delay or dropout of the packets, and thus large localization errors might occur if not addressed [11].Several strategies have been proposed for mitigating the bad effect of NLOS errors, such as statistical identification [12], hypothesis test [13], and robust parameter estimation [14].In [15], the switching behavior of NLOS and the lineof-sight (LOS) has been described by a hidden Markov Model, and an estimator has been designed by combining Kalman filter with the interacting multiple model (IMM) approach.These results are further extended to nonlinear AOA measurement by using the MUSIC method in [16].Similar approach has also been used to observe a mobile objective in mixed LOS/NLOS environments by using individual measurement and LOS detection [17].However, little research has been investigated to mitigate the delay and dropout problems caused by NLOS propagation.In [18], a joint AOA and delay estimation method has been proposed for space-time coherent distributed signals based on search.The problem of joint AOA/RSS based state estimation for NNS in mixed LOS and NLOS environment has not been studied.
In reality, almost all networked systems can record the results over a recent finite horizon; for such time-varying systems, one would be more interested in the optimal estimation based on the finite recent data.When it comes to the filter design issue, finite-horizon estimation is an effective approach and gives rise to many available methods in terms of moving horizon estimation [1,19], finite-horizon H ∞ fault estimation [20], and finite-horizon FIR estimation [21].However, finite-horizon estimation approach has its own limitations, especially on expensively computational burden [22], with the reasons in terms of the adoption of finite recent measurements, the inversion computation [23], and the singularity problem [24].One of the improvement methods is to manage the horizon size (window length), and several approaches [25] have been proposed.Although the existing approaches are effective with linear time-invariant systems, they can be less effective with wireless networked systems, with the reason that the constant (i.e., fixed) horizon size of the existing methods may be not able to handle the network-induced constraints owing to mixed LOS/NLOS environment.Thus, it is desirable to adapt the horizon size in finite-horizon estimation, and this motivates us to investigate this issue.
Summarizing the above analysis, it can be concluded that there is a great need to examine how the mixed LOS/NLOS environments affect the performance of the distributed estimation over a sensor network with RSO data.To address the effects of NLOS errors and random delays, a jump Markov system has been modeled with the switching parameters corresponding to LOS/NLOS errors.An adaptive finite-horizon group estimator (AFGE) has been proposed, where the horizon size can be adjusted in real time according to stochastic parameters and random delays.A numerical example is proposed to verify the effectiveness of the proposed AFGE scheme.The main contributions of this research can be highlighted as follows.(i) The observation model of NNS is a special one that has complementary property and is affected by switching LOS/NLOS errors and random transmission delay.(ii) An observation reorganization scheme and a complementary fusion strategy have been introduced to DFIR estimation procedure to mitigate the impacts of delay and complementary property, respectively.(iii) The proposed AFGE scheme contains an AHG policy, which is proposed to manage the horizon size.
The remainder of this paper is organized as follows.In Section 2, the graph-based network background is introduced, while the NNS model and some preliminaries are briefly outlined.Section 3 describes the derivation of a new DFIR estimator.Section 4 proposes the AHG method and completes the AFGE.In Section 5, an application of clustered UAVs is given for the designed AFGE.Finally, the conclusions are drawn in Section 6.

Preliminaries and Problem Formulation
In this section, we introduce some preliminaries related to the description of communication network and then present the problem setup.

Graph-Based Network Description.
Suppose that  Σ vehicles form into an Ad hoc network, where every vehicle acts as a networked node and carries out the uniform communication protocol, that is, [1,2,19].The communication topology of information flow between networked vehicles is described by a directed graph is the set of action radius, and  ∈ C  represents the sender.The edge  [→] = (, ) ∈ E  indicates that node  can receive the information from node ; that is, (, ) ∈ E  ⇒  [→] ≤   .Specifically, we define the set of neighbors as follows.
Definition 1.Let  []   ∈ R 3 be the position of node  ∈ C  ; the neighbor set of node  at time  can be defined as where  sup and  inf denote the supremum and infimum radii of available communication range, respectively.Note that the Figure 1: Remote sensing neighbors for networked navigation system.
relative distances between node  and N []   are changeable with time ; thus the member of N []   may also be changed dynamically.Besides, the effective area for cooperative neighbors can be defined by  sup and  inf , namely, receive-search area (RSA), as depicted in Figure 1.
The model of RSA is defined as follows.
Definition 2. Given a generic node  ∈ C  , its geographic neighbor  ∈ C  is defined as in the RSA of node , if node  is in the hollow sphere between  inf and  sup , which are determined by RSS method as lg where  sup and  inf denote the received SNRs corresponding to  sup and  inf , respectively, PL dB is the propagation loss (dB) in free space propagation model [12],  is the path loss exponent, 2 ≤  ≤ 4, and  MHz is the electromagnetic frequency.

NNS Model and Problem Formulation.
In this paper, the NNS is assumed as the essential navigation equipment of a generic vehicle  ∈ C  .The dynamics of node S can be modeled as the discrete-time linear stochastic system where   denotes system state; Φ  and Γ  denote the system matrices which can be used to represent the motions such as the velocity model and coordinate turn model.The process noise   is zero-mean white Gaussian with covariance matrix   .A set of cooperative UAVs that provide two kinds of observations, (i) navigational states of the observed neighbors, denoted by x {N}  = {x []   |x []   ,  ∈ N , ), and (ii) relative measurements (RM) between  and the neighbors  ∈ N []   , denoted by z {N}  = { []   | []   ,  ∈ N []   }, including relative distance and relative angle, are assumed to be calculated by RSS and AOA, respectively.The detailed deductions can be found in [12,16], with the basic equations as Compared to the previous DSE problems [5,20,25], a typical feature here is that the observations in x {N}  and z {N}  are mutually complementary; that is, each local observation of node  can only be derived through the fusion of multiple  []   and  []   ( ∈ N []  ).The measure noise covariance  []   in Cartesian coordinates is  []   =  ( []  RSS ,  []  AOA, ,  []  AOA, ,  []  shad ,  []  AOA, ,  []  AOA, ) , (5) where AOA, , and  []  AOA, are defined in (4).In LOS environment, the measurements (4) are corrupted by the noise  []   , which can be modeled as zeromean white Gaussian noise; that is,  []   ∼ ( []   ; 0,  []  ,1 ).In NLOS environment, the measurement is corrupted by two kinds of error sources: Gaussian noise  []   and measurement bias error  []   .The bias error can be modeled as a biased distribution; that is,  []   ∼ ( []   ;  []   , Σ []  ).It is also assumed that  []   and  []   are independent.Thus, the CM noise in (4) can be represented by For the sake of notations, the measurement equation ( 4) can be represented in a uniform form: where  []   is the nonlinear measurement function, depending on specific RM methods; the measurement noise  []   ( []   ) is assumed to be zero-mean white Gaussian with covariance matrix  []  ,1 in the LOS condition; that is,  []  ,1 ∈ ( []   ; 0,  []  ,1 ); and it is assumed to be white Gaussian with mean  []   and covariance matrix  []  ,2 in the NLOS condition; that is,  []  ,2 ∈ ( []   ;  []   ,  []  ,2 ). []   is introduced to indicate the transition of LOS and NLOS measurement errors; that is,  []    = 1 represents the LOS condition and  []    = 2 represents the NLOS condition.The TPM of  []   is assumed to be Π It should be pointed out that the two-state Markov chain  []   is dependent on the cooperative UAV, since the objective might be in LOS condition for one UAV but in NLOS condition for another one.
Under the above mixed LOS/NLOS propagation environment, transmission delays (TDs) may decay the accuracy of relative measurement.To mitigate this disadvantage, the observed CM with TDs is modeled as with  []  , defined as a binary random variable indicating the arrival of the observation packet for state ( − ); that is, − is received at the instant ; 0, otherwise;  ∈ {1, 2, . . ., ℓ} .
Obviously, Prob( []   , = 1) =   ,  = 1, . . ., ℏ.Under Assumption 3, we know that the possible received observations at time  ( ≥ ℏ) are In the real-time networked systems, the state () can only be observed at most one time, and thus  []  , ,  = 1, . . ., ℏ, must satisfy the following property: When  < ℏ, the observation of ( 10) is written as where we set ỹ[]  ≡ 0 for  <  ≤ ℏ.Then the estimation problems considered in this paper can be stated as follows.
Problem   .For a generic node  ∈ C  , given the set of navigation knowledge from the neighbors x[]  ( ∈ N []  ) with the stamp  ( > 0), the corresponding relative measures ỹ [𝑖]  ( ∈ [ − Ξ [] , ]) subject to NLOS errors and random delay, with the information  []  , , find a linear minimum mean square error filter x[] ( | ) for navigational state of the target, (), such that is minimized, while the filter gain is stochastic.

Delay-Aware FIR Estimator with Delayed Complementary Observations
In this section, we aim to establish a unified framework to solve the addressed optimal state estimation problem in the simultaneous presence of network-induced delay and complementary property under the mixed LOS/NLOS environment, while the observations are decoded from the packets of ℓ spatially distributed nodes.

Delayed Observation Reorganization.
In our research, the remote sensing observations (i.e., { []   ,  []   }) are impacted by delay and complementary issues and thus should not be adopted directly by the estimators.In this subsection, we focus on the delay issue; more specifically, we propose a preestimating scheme, including two steps, to reorganize the delay observations without dimensional augment.

Lemma 4. For the given time horizon
which implies that L 2 contains the same information as L 1 .

Complementary Fusion Strategy.
Let {ỹ []   (),  = 1, 2, . . ., ℓ} be the set of complementary observations generated at instant , the relative measures between objective  and its neighbors  ∈ N []   , that is, relative distance and relative angle, are calculated through RSS and AOA, respectively, as depicted in (4), and the measure noise covariance R[]  () in (17).
Hereafter, the fused measurement covariance  and the fused measurement variable  []   () ( ∈ {ℏ,  − }) can be expressed as Besides, the sensitivity matrix of the fused measurement variable (22) can be written as hereinto,  [] is the sensitivity matrix corresponding to ỹ[]  (): Note that the estimation error in this research may not always fall within the confidence level of the predicted covariance boundary.To avoid this problematic scenario, we introduce a new weighting factor  , as follows.

Delay-Aware FIR Estimation Algorithm.
In this subsection, we proposed a novel unbiased FIR estimator, namely, delay-aware FIR (DFIR) estimation algorithm, to realize the network-based state estimation of a generic node  ∈ C  based on the cooperative observation of its neighborhood N []   .Note that several unique network-induced constraints are involved, including complementary observations, Markov jump parameters, and random delay; hereinto, partial constraints have been transformed in Sections 3.1 and 3.2, which may simplify the design procedure of DFIR.
Prior to the main result of this section, let us recall a useful lemma that will be useful in DFIR algorithm.
Lemma 7 (see [24]).Suppose that the general trace optimization (GTO) problem is given as where A, B, C, D, E, and F denote the constant matrices with appropriate dimensions: C = C  > 0 and D = D  > 0. tr(J) is the trace of the main diagonal of J.
Thus, the unique solution to the GTO problem can be obtained as H where Λ = ACA  + D.
On the recent finite-time horizon [ − Ξ [] − ℏ,  − 1] of reorganized linear space L 2 , the receding horizon filter for (3) and ( 20) can be written as where H() is the gain matrix, Ỹ[] −1 is the augmented measurement vector, and () is the set of switching factors on the horizon [ − Ξ [] − ℏ,  − 1] defined by (34)-(36), respectively, as H() ≜ [ HΞ [] +ℏ,() HΞ [] +ℏ−1,() ⋅ ⋅ ⋅ H1,() ] , (34) For ease of notation only, we express the horizon size of estimator −1 can be rewritten in the batch form as where Substituting (37) into (33) and taking the expectation on both sides of (33), the following relations can be obtained: with the horizon initial conditions determined by Lyapunov equation on the horizon  ∈ [ 0 ,  − Ξ) as and, irrespective of the initial states, constraint (43) is required: Thus, the objective now turns to obtain the optimal gain matrix H  with the unbiasedness constraint (43), such that the estimation error   of the estimate x|−1 has the following minimum variance: By using Lemma 7, the gain matrix H can be obtained by the following correspondences: (45) Thus, when {Φ  , H, []    } ( ∈ [ − Ξ,  − 1]) is observable and Ξ [] + ℏ ≥ , the DFIR for the reorganized system (20) can be given as Remark 8.The batch form of RHE (44) requires the inversion computation of matrices Θ −1 Ξ,() and F  Ξ,() Θ −1 Ξ,() F Ξ,() , whose dimension will become large as the horizon length Ξ []  increases; besides, the singularity problem will be encountered due to the impacts of LOS/NLOS condition.
Remark 9.The FIR filter uses finite measurements of the recent time interval.The length of the interval is called horizon size, which is also referred to as the window size or memory size.In ( 13), the matrices with subscript "Ξ [] " are obtained using the information on the recent time interval where the horizon size is Ξ [] + ℏ.The large matrices defined in (13) are time-varying.

Adaptive Finite-Horizon Group Estimator
In this section, we introduce an adaptive horizon group (AHG) approach to manage the horizon size in DFIR estimator.Different from the previous horizon group shift policy [26], AHG policy is designed to adjust the horizon size of DFIR algorithm according to the dynamic changed cooperative neighbors and the concerned network constraints.The AHG algorithm was combined with the proposed DFIR estimator and obtained AFGE estimator.The detailed algorithm of estimating with AHG is presented below.
The first step of estimation with the DFIR is to construct a group of horizon sizes (i.e., horizon group).The horizon group at time  is denoted by G  and is defined as  where Ξ is the horizon size, Ξ   is the center horizon size at time ,  is the interval between horizon sizes, and ℏ + 1 is the total number of horizon sizes in a horizon group.Note that  []   impliedly reflected the possible transmission delay from the cooperative neighbor  ∈ N []   , and ℏ denotes the tolerable maximum transmission delay, which is defined in Assumption 3.
The second step is to execute the DFIR estimator repeatedly with the horizon sizes in G  , which produces a group of state estimates, x1  , x2  , . . ., xℏ+1  .The reliable estimate is then selected by maximizing the likelihood function of , where x ( Ξ) is the state estimate obtained from (46) with the horizon size Ξ.Note that the density function of where The state estimates are then evaluated based on their likelihoods, which can be computed as follows: where (x   ( Ξ)) is the likelihood of the state estimate x  ( Ξ) and H[]  () is the measurement matrix defined in (20): Thus, a reliable estimate is selected by minimizing J(x  ( Ξ)).We use J(x  ( Ξ)) as a measure of accuracy of the estimation result.The smaller the cost J(x  ( Ξ)) is, the more reliable the estimated state is.
The final step is to change the horizon group, which is called the AHG.If we determine Ξ   , G  is determined automatically using (47).The horizon size that produces a reliable estimate at time  is used as the center horizon size at time  + 1.Let x (Ξ   ) be the state estimate obtained from the FIR estimator using the horizon size Ξ   .The AHG can then be described by the following equation: In this way, the horizon group is moved (or shifted) toward the horizon size that produces good estimation performance.In the AHG algorithm, the horizon size varies over time.Thus, we impose the lower bound Ξmin and the upper bound Ξmax on the horizon size.We now summarize the estimation algorithm with DFIR, as depicted in Figure 2, whereas the detailed algorithm is presented as follows.
Algorithm 10 (AFGE estimator).Select design parameters of the AHG algorithm, such as ℏ, , Ξmin , and Ξmax .Set the initial value of the center horizon size as Ξ   = Ξmin .For  = Ξmin + 1, Ξmin + 2, . .., perform the following: (a) Construct horizon group G  that contains ℏ horizon sizes using definition (9) as follows: x where where   () and  V () denote the position and velocity of a generic UAV at time , respectively,   represents the sampling period, and   = 0.1; and () is a zero-mean white noise with variance   ,   = 0.The objective UAV updates its state essentially based on cooperative packets of its neighbors, which include the time stamp  and the navigational state of the sender The relative position and relative angle are measured by RSS and AOA methods, respectively, with the observation models as in (4).
For RSS measurements, the transmission power is taken as  = 20 dBm, the path loss exponent is  = 2.1, and  = 32.44.The standard deviation for measurement noise of AOA is 0.1 degrees.The variances of LOS and NLOS measurement noises are taken as  []  ,1 = 64 and  []  ,2 = 100, respectively.The bias of the NLOS measurement error is assumed to be  []   = −5.The occurrence probability of NLOS measurement error is taken as  NLOS = 0.5 for each neighbor.The transition probabilities of Markov chain  []   are set as  (2)  11 =  (2)  22 = 0.9 and  (2)  12 =  (2) 21 = 0.1.To reduce the computational cost, not all the cooperative measurements are used; instead, only ℓ = 5 strongest received signals are adopted for state update of the objective UAV.
As to the random delay, it is assumed that () ∈ {0, 1, 2, 3}.() is a prior known to the estimator and its paths can be described by  []  , ( = 1, 2, . . ., ℓ) with the restriction A distributed fusion receding horizon estimator (DRHE) in [25] is adopted to compare with DFIR in Section 3 and the AFGE in Section 4. Let RMSE denote the root mean square error for the estimation of  []   ; that is, ((1/M) ∑  =1 ( , where M = 500 is the Monte Carlo simulation runs.

Simulation Results and Analysis.
In this subsection, several key properties of the proposed AFGE approach, that is, AHG scheme and estimation errors, are tested on the networked UAVs with the models in Section 5.1.The design parameters of the AFGE algorithm are taken as ℏ = 3,  = 1, Ξ min = 2, and Ξ max = 40.First, we verify that AHG improves the estimation performance of the DFIR estimator by adapting the horizon size.To this end, we compare the AFGE with DFIR and DRHE.While the DFIR uses a constant horizon size, the AFGE uses the adaptive horizon size.Figure 4 depicts the RMSE comparisons among DFIR, DRHE, and AFGE for diverse horizon sizes in the rectilinear orbit determination problem.In addition, this figure shows the RMSE of the AFGE estimator.The DFIR estimator produces the minimum RMSE of 0.216 when the horizon size is 12, whereas the minimum RMSE of DRHE is 0.320, with the horizon size of 13.The RMSE of the AFGE is 0.196, which is smaller than that of DFIR and DRHE.AFGE outperforms the DFIR using the best constant horizon size.Thus, it is verified that AHG improves the estimation performance of the DFIR.
Next, we consider the UAV navigation scenario with the initial settings as in Section 5.1.Besides, we set the horizon size of DFIR to Ξ [] = 12, according to the analysis in Figure 4.The simulation results can be found in Figures 5 and  6.
Hereinto, Figure 5(a) reports the localization results based on RSS/AOA relative measurement and the CPs of its neighbors, while the related parameters are recorded in Figures 5(b) and 5(c).It is clear from Figure 5(b) that the number of received CPs in each step is greater than four, which means the observations are sufficient for the geometric localization in three-dimension space [9].One path of () is given in Figure 5(c), based on which the optimal filter can be obtained directly by using the scheme in Sections 3 and 4. As expected, the localization result in Figure 5(a) demonstrates the validity of the proposed AFGE algorithm and navigation scheme.
More specifically, Figures 6(a) and 6(b) present the comparison of estimation results on location and velocity errors, respectively.The estimators of DFIR in Section 3 and DRHE [25] are chosen as the comparison with our proposed AFGE algorithm.
As shown in the simulation results, the convergence rate of the DRHE is faster than that of DFIR due to the fact that DRHE adopts a distributed fusion structure in the design of estimator; however, the convergence error of the DFIR is smaller than that of DRHE, which is partly due to its reorganization of delayed observations and is also due to the design of DFIR considering the Markov jumping of LOS/NLOS errors.Furthermore, the performance of AFGE outperforms DRHE and DFIR; the reason can be owed to its reorganization scheme for delayed observation on one hand and considering the Markov jumping of LOS/NLOS errors on the other hand.Besides, the proposed AFGE also benefits from the AHG policy, which can manage the horizon size, thus acquiring the fastest convergence rate with the smallest estimation error.

Conclusions and Discussions
In this paper, an adaptive horizon estimator has been addressed to solve the state estimation of NNS with the features of remote sensing complementary observations (RSOs) under mixed LOS/NLOS environments.An adaptive finitehorizon group estimator (AFGE) has been proposed, where the horizon size can be adjusted in real time according to stochastic parameters and random delays.First, a delay-aware FIR (DFIR) estimator has been derived with observation reorganization and complementary fusion strategies.Second, an adaptive horizon group (AHG) policy has been proposed to manage the horizon size.The AFGE algorithm is thus realized by combining AHG policy and DFIR estimator.A numerical simulation example has been used to demonstrate the potential of the proposed approach to robust estimation in terms of both performances and computational tractability.Future research will focus on other typical issues of NNS in terms of multirate fusion problem and cooperative attitude estimation problem.

Figure 3 :Figure 4 :
Figure 3: Initial settings of network topology and ideal trajectory.(a) Initial topology of the networked vehicles.(b) Ideal trajectory of objective vehicle.