Next Article in Journal
MIROS: A Hybrid Real-Time Energy-Efficient Operating System for the Resource-Constrained Wireless Sensor Nodes
Next Article in Special Issue
Laser Gyro Temperature Compensation Using Modified RBFNN
Previous Article in Journal
Novel Wearable and Wireless Ring-Type Pulse Oximeter with Multi-Detectors
Previous Article in Special Issue
HOPIS: Hybrid Omnidirectional and Perspective Imaging System for Mobile Robots
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Autonomous Navigation System Using a Fuzzy Adaptive Nonlinear H∞ Filter

1
School of Automation Science and Electrical Engineering, Beihang University, 37 Xueyuan Road, Haidian District, 100191 Beijing, China
2
School of Control and Automation, Ecole Militaire Polytechnique, EMP, Bordj El Bahri, 16111 Algiers, Algeria
*
Author to whom correspondence should be addressed.
Sensors 2014, 14(9), 17600-17620; https://doi.org/10.3390/s140917600
Submission received: 6 May 2014 / Revised: 5 September 2014 / Accepted: 12 September 2014 / Published: 19 September 2014
(This article belongs to the Special Issue Optical Gyroscopes and Navigation Systems)

Abstract

: Although nonlinear H∞ (NH∞) filters offer good performance without requiring assumptions concerning the characteristics of process and/or measurement noises, they still require additional tuning parameters that remain fixed and that need to be determined through trial and error. To address issues associated with NH∞ filters, a new SINS/GPS sensor fusion scheme known as the Fuzzy Adaptive Nonlinear H∞ (FANH∞) filter is proposed for the Unmanned Aerial Vehicle (UAV) localization problem. Based on a real-time Fuzzy Inference System (FIS), the FANH∞ filter continually adjusts the higher order of the Taylor development thorough adaptive bounds (δi) and adaptive disturbance attenuation (γ), which significantly increases the UAV localization performance. The results obtained using the FANH∞ navigation filter are compared to the NH∞ navigation filter results and are validated using a 3D UAV flight scenario. The comparison proves the efficiency and robustness of the UAV localization process using the FANH∞ filter.

Graphical Abstract

1. Introduction

Unmanned Aerial Vehicles (UAVs) are rapidly becoming a strategic asset in today's military forces and in the civilian airspace community. They can be used in an increasing number applications, such as surveillance, reconnaissance, communication relay, target designation and payload delivery [1]. The term UAV encompasses a wide variety of robotic aircrafts that vary in size, shape, flight characteristics and level of operational autonomy. The autonomy of these vehicles requires the development of navigation and guidance algorithms for self-localization. One important aspect of autonomous navigation, which should be investigated, is the fusion of data from different sensors. The Inertial Navigation System (INS) and the Strapdown Inertial Navigation System (SINS) in particular have been a vital source of navigation for UAVs [1]. The SINS is considered as a comprehensive navigation source because it is the only source that provides complete navigational information, such as position, velocity, and attitude, at a high data rate and with great precision on a short-term basis. However, the SINS's diverging errors caused by the integration process require an absolute sensor, such as a Global Positioning System (GPS), to constrain these drifts. To circumvent this limitation, one cost effective solution is to resort to an integrated navigation system in which the unboundedly growing trend of the errors of the SINS is contained by external navigation aids. The SINS has been augmented by different navigation aids over the last two decades, and GPS is the most prominent system used in integrated navigation systems among the systems that provide position and velocity fixes for the SINS.

The technology of multisensor data fusion is rapidly evolving in aerial navigation, where significant research has been devoted to developments concerning the UAV SINS/GPS localization problem in the last decade. One of the major concerns has been the issue of improving the accuracy, coverage, and reliability of the automatic navigation system within the imposed weight and cost constraints. The most mature technique used in navigation data fusion is the Kalman Filter (KF), which is a stochastic estimator that is typically used to solve various estimation problems and that is applied to a linear process and an observation model using a Gaussian statistical distribution of the process and observation noise. Various approximations have been developed in the literature, such as Extended Kalman Filters (EKFs), which is based on a first-order linearization of the nonlinear stochastic system models with the assumption of Gaussian distributed noises, to overcome the nonlinear filtering problems of integrated navigation systems. Although the EKF maintains the elegant and computationally efficient updated form of the KF, it suffers from a number of drawbacks [2]. If the filter is ill-conditioned due to modeling error, incorrect tuning of the covariance matrices, or initialization, and the subsequent estimation error will affect the linearization error. In turn, the latter will affect the estimation process and is known as a filter divergence. For this reason, the EKF requires greater care in modeling and tuning compared to the linear KF [3].

In this paper a robust alternative to the EKF that is based on NH∞ filtering to avoid the issues linked with modeling error and noise uncertainties is investigated to solve the UAV localization problem. The advantage of this filtering approach is that no assumptions are made regarding the statistical proprieties of the disturbance, and the filter is designed to minimize the estimation error due to the worst-case estimation error rather than the covariance of the estimation error [4]. In recent years, increased interest in the H∞ filter has led to several publications that address the H∞ nonlinear filter [510], where different approaches have been developed. However, in the current paper, we consider the approach used in studies [5,10] to construct a state estimator based on linearization for approximating the robust filtering known as the Robust Extended Kalman Filter (REKF), Extended H∞ Filter or Nonlinear H∞ filter. For the latter, the higher-order terms of the Taylor series expansion are not neglected but rather are assumed to be functions of the state estimation error and of the exogenous inputs, which have bounded H∞ norms and which lead to a min-max estimation that can be treated using standard H∞ filter methods [5].

It should be mentioned that although the nonlinear H∞ filter offers a good performance without presuming characteristics of the process and/or measurement noises, the filter still requires additional tuning parameters that remain fixed and that need to be determined using trial and error [3]. These parameters may be used to control the compromise between the two performance criteria and the scaling of the inputs to accommodate linearization errors [5]. Motivated by this issue, the Adaptive Robust Extended Kalman filter for a nonlinear system was proposed in [11], where the primary goal was to design an estimator based on stability analyses and to determine if the error covariance matrix should be reset based on the hypothesis test [11]. It should be noted that only the tuning of the disturbance attenuation (γ) has been considered in the filtering process, and the higher order terms of the Taylor development have been neglected when calculating the Jacobian. The results of the current paper are thus complementary to the results obtained in [3]. In this paper we extend the nonlinear H∞ (NH∞) filter to include a fuzzy adaptive scheme.

To address the issues associated with the NH∞ filter, a new SINS/GPS sensor fusion scheme known as the Fuzzy Adaptive Nonlinear H∞ (FANH∞) filter for the UAV localization problem is proposed in this study. Based on a real-time Fuzzy Inference System (FIS), the FANH∞ filter continually adjusts the higher order of the Taylor development thorough the adaptive bounds (δi) as well as the adaptive disturbance attenuation (γ), which significantly increases the UAV localization performance. The results obtained by the FANH∞ navigation filter were compared to the NH∞ navigation filter results and were validated using a 3D UAV flight scenario. The comparison proves the efficiency and robustness of the UAV localization process using the FANH∞ filter.

The remainder of this paper is organized as follows. The sensor model for the SINS and the GPS is discussed in Section 2. A brief overview of the EKF algorithm is stated in Section 3. Section 4 contains the formulation of the Nonlinear H∞ (NH∞) filter and its drawbacks. Section 5 is devoted to the Fuzzy Adaptive Nonlinear H∞ (FANH∞) filter. Lastly, the simulation results are provided to illustrate the performance of the FANH∞ filter for the UAV localization problem and are compared with the Nonlinear H∞ (NH∞) filter.

2. Mathematical Model of Integrated Navigation System for SINS/GPS

2.1. References Frame

An important part of the inertial navigation system analysis consists of determining the relation between the different frames. The body frame is the basic frame for the inertial sensor: the x-axis is pointing forward, the y-axis is pointing to the right, and the z-axis completes the right-hand orthogonal system by pointing downwards. The North-East-Down (NED) is the navigation frame: the N vector is pointing North, the E vector is pointing East, and the D vector is pointing Down along the local gravity vector, as indicated in Figure 1 [12].

The Inertial Measurement Unit (IMU) measures the acceleration (ax,ay,az) and the rotation rate (p,q,r) high update rate [13]. These vectors are transformed to the navigation frame. The transformation matrix used is the Direct Cosine Matrix Cbn, which represents the attitude of the body frame with respect to the navigation frame and can be expressed in terms of three rotational Euler angles R(ϕ), R(θ) and R(ψ), which signify the roll, pitch and yaw, respectively, as follows [12,13]:

C b n = R ( ϕ , θ , ψ ) = R ( ϕ ) R ( θ ) R ( ψ )
C b n = [ 1 0 0 0 cos ϕ sin ϕ 0 sin ϕ cos ϕ ] [ cos θ 0 sin θ 0 1 0 sin θ 0 cos θ ] [ cos ψ sin ψ 0 sin ψ cos ψ 0 0 0 1 ]
C b n = [ cos ( θ ) cos ( ψ ) cos ( θ ) sin ( ψ ) sin ( θ ) sin ( θ ) sin ( ϕ ) cos ( ψ ) sin ( ψ ) cos ( ϕ ) sin ( ψ ) sin ( θ ) sin ( ϕ ) + cos ( ψ ) cos ( ϕ ) sin ( ϕ ) cos ( θ ) sin ( θ ) cos ( ϕ ) cos ( ψ ) + sin ( ψ ) sin ( ϕ ) sin ( ϕ ) sin ( θ ) cos ( ϕ ) cos ( ψ ) sin ( ϕ ) cos ( ϕ ) cos ( θ ) ]

2.2. Equation of Motion

We can transform the rotation rates (p,q,r) from the body frame to the navigation frame to calculate the Euler angle rates (ϕ̇,θ̇,ψ̇) as follows:

[ p q r ] = [ ϕ ˙ 0 0 ] + R ( ϕ ) [ 0 θ ˙ 0 ] + R ( ϕ ) R ( θ ) [ 0 0 ψ ˙ ]
Then, the equation can be written as follows:
[ p q r ] = [ 1 sin ( θ ) 0 0 cos ( θ ) cos ( θ ) sin ( ϕ ) sin ( ϕ ) 0 cos ( θ ) cos ( ϕ ) ] [ ϕ ˙ θ ˙ ψ ˙ ]
[ p q r ] = C ( p , q , r / ϕ ˙ , θ ˙ , ψ ˙ ) [ ϕ ˙ θ ˙ ψ ˙ ]

To solve (ϕ̇,θ̇,ψ̇)T, we can calculate C ( p , q , r / ϕ ˙ , θ ˙ , ψ ˙ ) 1. Then, the Euler angle rates can be expressed as follows:

[ ϕ ˙ θ ˙ ψ ˙ ] = [ 1 sin ( ϕ ) tan ( θ ) cos ( ϕ ) tan ( θ ) 0 cos ( ϕ ) sin ( ϕ ) 0 sin ( ϕ ) sec ( θ ) cos ( ϕ ) sec ( θ ) ] [ p q r ]

2.4. Nonlinear Model Using Euler Angles

The nonlinear model of the SINS can be defined as follows:

{ x ˙ ( t ) = f ( x ( t ) , u ( t ) , t ) y ( t ) = h ( x ( t ) , u ( t ) , t )
where x is the state vector, which contains the position, velocity, Euler angles, constant random drifts in the gyros and constant random biases in the accelerometers as follows:
x = [ X Y Z U V W ϕ θ ψ ε b x ε b y ε b z b x b y b z ] T
where εbx, εby and εbz are the constant random drifts in the gyros and ∇bx, ∇by and ∇bz are the constant random biases in the accelerometers.

Thus, u represents the IMU outputs, where the angles' rate and accelerations can be expressed as follows:

u = [ p , q , r , a x , a y , a z ]

We can place Equations (13), (11) and (7) into the matrix, which provides the (15×15) state transition matrix to present the nonlinear model that describes the air vehicle [12]. The nonlinear SINS state model can be written as follows:

f ( x , u ) = [ [ cos ( θ ) cos ( ψ ) cos ( θ ) sin ( ψ ) sin ( θ ) sin ( θ ) sin ( ϕ ) cos ( ψ ) sin ( ψ ) cos ( ϕ ) sin ( ψ ) sin ( θ ) sin ( ϕ ) + cos ( ψ ) cos ( ϕ ) sin ( ϕ ) cos ( θ ) sin ( θ ) cos ( ϕ ) cos ( ψ ) + sin ( ψ ) sin ( ϕ ) sin ( ϕ ) sin ( θ ) cos ( ϕ ) cos ( ψ ) sin ( ϕ ) cos ( ϕ ) cos ( θ ) ] T [ U V W ] [ a x + V r W q + g e sin ( θ ) a y U r + W p g e cos ( θ ) sin ( ϕ ) a z U q V p g e cos ( θ ) cos ( ϕ ) ] [ 1 sin ( ϕ ) tan ( θ ) cos ( ϕ ) tan ( θ ) 0 cos ( ϕ ) sin ( ϕ ) 0 sin ( ϕ ) sec ( θ ) cos ( ϕ ) sec ( θ ) ] [ p q r ] [ 0 0 0 ] [ 0 0 0 ] ]

The SINS, which is equipped with high-rate sensors (gyros and accelerometers), is a self-contained navigation system; it provides high precision and accuracy for shorter durations of time and is immune from external effects, such as jamming. However, during navigation, the SINS errors accumulate and increase, which causes the SINS to be unsuitable for long-term navigation [14,15]. The GPS can provide accurate, real-time three-dimensional position and velocity information with only random errors, which do not increase unboundedly. The powerful synergy between the GPS and SINS is illustrated in Figure 2.

This synergy is possible, in part, because both systems have extremely complementary error characteristics. The short-term position errors from the SINS are relatively small, but they degrade without bound over time. Conversely, the GPS position errors are not as suitable over the short term, but they do not degrade with time [16].

An essential component in a satellite navigation system, e.g., the GPS, is the availability of satellites correctly transmitting coded signals from known positions. Three satellites are required to provide three distance measurements, while a fourth satellite is required to remove receiver clock error. The technique used is trilateration based on the geometry of circles, where an unknown point can be calculated from three known points. The intersection of the arc corresponding to the three distances defines the unknown point relative to the known points. The three measurements can be used to solve the three equations to determine the longitude, latitude and elevation of the receiver [17]. The calculation using four satellites provides the receiver with sufficient information to calculate its position with high accuracy. Four satellites, rather than three, are required because the clock in the receiver is not accurate enough. The fourth distance measurement provides information from which the clock errors in the receiver can be corrected, and the receiver clock is synchronized to the GPS with an accuracy of greater than 100 ns.

The GPS satellites transmit two signals at different frequencies: L1 at f1 = 1575.42 MHz and L2 at f2 = 1227.6 MHz. The GPS system provides two categories of service. The Precise Positioning Service (PPS) receivers track both P codes on L1 and L2 frequencies. The PPS is used primarily by military users because the P code is encrypted into the Y code before transmission and requires decryption equipment in the receiver. The Standards Positioning Service (SPS) receivers track the C/A (Clear Acquisition) code on L1 [16,17].

The measurement model, which is related to the position and velocity of the UAV used in this paper can be expressed as follows:

h ( x , u ) = [ I 3 x 3 0 3 x 3 0 3 x 9 0 3 x 3 I 3 x 3 0 3 x 9 ] x
where [X Y Z U V W ϕ θ ψ εbx εby εbzbxbybz]T.

3. Extended Kalman Filter

Most real world systems, such as navigation systems, are nonlinear, and the standard Kalman filter cannot be used. To overcome this limitation, the Extended Kalman Filter (EKF) approximates the nonlinear system using the Jacobian to calculate the covariance of a random vector propagating through the nonlinear model [2,18,19]. The zero-order hold (ZOH) is used in this paper to convert the system defined in Equation (14) to a nonlinear discrete-time state transition equation. The system and the measurement equations can be written in a discrete form as follows [20]:

x k = f k 1 ( x k 1 , u k 1 , w k 1 )
y k = h k ( x k , v k )
where wk and vk are the uncorrelated zero mean white noise process with the known covariance Qk and Rk, respectively.

The EKF approximate nonlinear system dynamics and measurement vehicle models uses the Jacobian to calculate the covariance of a random vector propagating through the nonlinear models. The nonlinear model and the measurement model expanded around the filtered and predicted estimates of k and k−1 can be defined as follows:

x k = f ( x ^ k 1 / k 1 , u k 1 ) + Δ f k ( x ) [ x k x ^ k / k ] + Δ 1 ( x k x ^ k / k ) + [ Δ f w ( x ) + Δ 2 ( x k x ^ k / k ) ] w k
y k = h ( x ^ k / k 1 , u k ) + Δ h k ( x ) [ x k x ^ k / k 1 ] + Δ 3 ( x k x ^ k / k 1 ) + ν k
where Δfk(x) is the Jacobian of f evaluated at xk−1, the filter state error k/k−1 = xkk/k−1, the predictor state error k/k−1 = xkk/k−1, Δfw(x) is the Jacobian of (f/wk) evaluated at xk−1, Δhk(x) is the Jacobian of h evaluated at xk−1, and Δi=1,..3 represents the higher-order terms of the Taylor series norm, which are bounded as ∥Δi∥ ≤ δi [13,20]. The reformulated state and measurement model after neglecting the higher-order terms of the Taylor series can be expressed as follows [13]:
x k + 1 = F k x k + B k w k
y k = H k x k + ν k
where Fk = Δfk(k/k) and Bk = Δfw(k/k).

The time update of the estimation error covariance can be defined as follows:

x k + 1 / k = f ( x k / k , u k , 0 )
P k + 1 / k = F k P k / k F k T + B k Q k B k T

The measurement update of the state estimate and the estimation-error covariance can be defined as follows [20]:

K k = P k / k 1 H k T ( H k P k / k 1 H k T + R k ) 1
x ^ k / k = x ^ k / k 1 + K k [ y k h k ( x ^ k / k 1 ) ]
P k / k = P k / k 1 P k / k 1 H k T ( H k P k / k 1 H k T + R k ) 1 H k P k / k 1 = ( I K k H k ) P k / k 1

The EKF has been typically used in several applications; however, its implementation assumes that the process and measurement models are known. When there are large deviations in the estimated system state trajectory, the nonlinear model in Equations (19) and (20) is weakly approximated by the Taylor series expansion around the conditional mean, hence the need for the higher-order terms of the Taylor expansion [3,5].

4. Nonlinear H∞ Fitler

The robust filters take different forms depending on the type of disturbances that are considered [11], whereas the common performance criterion of the filter is to ensure a bounded energy gain from the worst possible disturbance to the estimation error. The structure of the nonlinear H∞ algorithm used in this paper is the same as that developed in [5] and is proposed to solve the SINS/GPS UAV localization problem in [3]. The NH∞ filter is used to estimate the nonlinear model given in Equation (14) and satisfy the H∞ performance criterion for all uncertainties Δ1, Δ1 and Δ3 that are defined in Equations (21) and (22) and their norm bound [5]. Instead of the system defined in Equations (21) and (22), we consider the system defined as follows:

x k + 1 = F k x k + B k w k + M k + T k
y k = H k x k + ν k + ξ k + ϕ k
x k / k = x k x ^ k / k
where Tk = Δ1(k/k) + Δ2(k/k)wk and ϕk = Δ3(k/k−1) are extra exogenous inputs [5] fulfilling the following conditions:
T k δ 1 2 x k / k 2 2 + δ 2 2 w k 2 2
ϕ 1 2 2 δ 3 2 x k / k 2 2
M k = f k ( x ^ k / k ) F k x ^ k / k
ξ k = h k ( x ^ k / k 1 ) H k x ^ k / k 1

We can rewrite Equations (30) and (31), which contain the extra terms Tk and ϕk not used in the EKF, by scaling w and v [5,10] as follows:

x k + 1 = F k x k + B k c w w k + M k
y k = H k x k + c v ν k + ξ k
where:
c v 2 = 1 γ 2 δ 1 2 γ 2 δ 3 2
c w 2 = c v 2 ( 1 + δ 2 2 ) 1

The NH∞ has the structure of the EKF defined in Equation (25) to Equation (29), with the exception of the approximate error covariance correction (29), which can be substituted with:

P k / k = P k / k 1 P k / k 1 [ C k T H k T ] [ C k P k / k 1 C k T γ 2 I C k P k / k 1 H k T H k P k / k 1 C k T H k P k / k 1 H k T + R k ] 1 [ C k H k ] P k / k 1
where:
-

Ck = I; and

-

wk and νk are scaled using cw and cv, respectively.

The extended H∞ filter reverts to the EKF when the state error (xkk/k) and the process noise are extremely small; furthermore, γ → ∞ [5].

5. Fuzzy Adaptive Nonlinear H∞ Filter

By referring to [3,5,6,10], the parameters of the NH∞ filter remain fixed during their processing. The equations defined in Equations (37) and (38) have parameters δ1, δ2, δ3 and γ that can be adjusted and adapted in response to the parameters' uncertainty and change in environment. A new concept regarding the SINS/GPS integration based on the Fuzzy Adaptive Nonlinear H∞ (FANH∞) filters for the UAV localization problem is investigated in this paper. The adaptive approach based on the Fuzzy Inference System (FIS) is suggested to automatically tune the parameters of the NH∞ (δ1, δ2, δ3 and γ) filter. The FANH∞ filter continually adjusts the higher-order terms of the Taylor development thorough the adaptive bounds (δ1, δ2, δ3) as well as through the adaptive disturbance attenuation γ, which significantly increases the UAV localization performance. Online tuning using the FIS offers robust behavior without decreasing the accuracy and guarantees the boundedness of the estimator error even with the unknown disturbance and the linearization error. Thus, the proposed study consists of adjusting the four parameters δ1, δ2, δ3 and γ of the NH∞ filter using two Fuzzy Inference Systems. The developed FIS is illustrated in Figure 3 and consists of two fuzzy controllers known as FIS-1 and FIS-2 operating separately.

The first Fuzzy Inference System (FIS-1) has three inputs, position error (ΔPe), velocity error (ΔVel) and attitude error (ΔAtt), that represent the linearization errors that can be determined by subtracting the linearized nonlinear state model from the linearized nonlinear state model. The outputs of the first FIS-1 are δ1, δ2 and δ3.

Furthermore, the estimation environment in the case of the SINS/GPS kinematic applications is subject to change in the Gyroscope Drift (Gyro Drift) and in the Accelerometer Bias (Acce Bias), which represent the two inputs of the second FIS-2 that are provided as the output γ.

The output of the two fuzzy controllers primarily depends on the membership function and on the definition of the fuzzy rules. The input variables of the first FIS, i.e., the position error (ΔPe), velocity error (ΔVel) and attitude error (ΔAtt), are divided into six triangular fuzzy sets, while the second FIS has two inputs, the accelerometer bias (Acce Bias) and the gyroscope bias (Gyro Bias), where each input is divided into four triangular fuzzy sets. The accelerometer and gyroscope bias are estimated by the FANH∞ filter simultaneously.

The FIS-1 control rules can be presented as follows:

  • 1-IF (ΔPe is P) AND (ΔVel is P) AND (ΔAtt is P) THEN (δ1 is P) (δ2 is P) (δ3 is P).

  • 2-IF (ΔPe is P) AND (ΔVel is P) AND (ΔAtt is G) THEN (δ1 is P) (δ2 is M) (δ3 is M).

  • 3-IF (ΔPe is P) AND (ΔVel is G) AND (ΔAtt is P) THEN (δ1 is P) (δ2 is G) (δ3 is M).

  • 4-IF (ΔPe is P) AND (ΔVel is G) AND (ΔAtt is G) THEN (δ1 is P) (δ2 is G) (δ3 is G).

  • 5-IF (ΔPe is G) AND (ΔVel is P) AND (ΔAtt is P) THEN (δ1 is P) (δ2 is G) (δ3 is P).

  • 6-IF (ΔPe is G) AND (ΔVel is G) AND (ΔAtt is G) THEN (δ1 is M) (δ2 is M) (δ3 is M).

The FIS-2 control rules can be presented as follows:

  • 1-IF (Gyro Drift is P) AND (Acce Bias is P) THEN (γ is G).

  • 2-IF (Gyro Drift is G) AND (Acce Bias is P) THEN (γ is M).

  • 3-IF (Gyro Drift is G) AND (Acce Bias is G) THEN (γ is P).

  • 4-IF (Gyro Drift is P) AND (Acce Bias is G) THEN (γ is M).

6. Simulation and Discussion of Results

We present our simulation results to validate the proposed Fuzzy Adaptive Nonlinear H∞ filter (FANH∞) for the Unmanned Aerial Vehicle localization problem. The results of our approach are compared with other navigation filtering approaches. The sampling rates used for each sensor and the update rate of the filters used in this study can be stated as follows:

f SINS = 100 Hz , f EKF = 10 Hz , f N H = 10 Hz , f GPS = 1 Hz , f FANS = 10 Hz .

The simulation results provided in Figures 4, 5 and 6 represent the estimated UAV position obtained using the SINS position, the NH∞ filter and the FANH∞ filter, respectively, in the x-, y- and z-axes. As seen from these figures, the performance of the FANH∞ filter is significantly greater than that of the NH∞ filter (bounds are predefined), which confirms the efficiency of the adaptive tuning of the NH∞ filter bounds. Table 1 presents and compares the average of 100 groups of standard deviations in the x-, y- and z-axes with the EKF, NH∞ and FANH∞ filters. It is evident from the table that the proposed filter provides a more accurate position without any pre-assumption of the characteristics of the process and measurement noises or the H∞ bounds. The automatic tuning of the NH∞ filter bound significantly reduces the accuracy of the position estimation. Similar results have been obtained for the velocity estimation. From Figures 7, 8 and 9, we can observe the benefit of using fuzzy adaptive tuning for the NH∞ bounds (δ1, δ2, δ3 and γ).

Table 2 provides a comparison of the computation time between the EKF, NH∞ and FANH∞ filters. As can be observed from this table, the proposed FANH∞ filter is computationally expensive compared to the EKF and NH∞ filter approaches. However, it does not affect the real-time processing of our SINS/GPS algorithm because the frequency of the FANH∞ filters is 67.56 Hz (Table 2), whereas the required frequency for the FANH∞ filter (in our case) is 10 Hz. Furthermore, the FANH∞ filter significantly improves the precision of the UAV localization process compared to the standard NH∞ filter.

We evaluate the computation time between the NH∞ and FANH∞ filters in Table 2 for 100 iterations because it is more significant. Figure 10 provides a comparison of the 3D trajectory of a UAV during navigation using the SINS/GPS fusion. Figures 11, 12 and 13 present a comparison of the error covariances obtained from the covariance propagation in the x-, y- and z-axes, respectively. It is evident that the FANH∞ filter (adaptive bounds) is more accurate than the classical NH∞ filter, where the bounds are fixed (fixed bounds). Similar results for the error covariance obtained from the covariance propagation for the UAV velocities in the x-, y- and z-axes are provided in Figures 14, 15 and 16, respectively.

Figures 17, 18 and 19 present a comparison of the error covariances in the x-, y- and z-axes, respectively, obtained from the true error. As seen from these results, the error covariances of positions obtained by the FANH∞ filter are smaller compared to those obtained by the H∞ filter. Similar results of the error covariance obtained from the true error for the UAV velocities in the x-, y- and z-axes are provided in Figures 20, 21 and 22, respectively.

7. Conclusions

In this paper, we have proposed a Fuzzy Adaptive Nonlinear H∞ filter for the SINS/GPS data fusion for UAV localization. The FANH∞ filter uses two fuzzy inference systems to adaptively tune the linearization error bounds and the H∞ norm bound. This adaptive tuning provides more robustness and consistency for the filter, which leads to results that are more accurate. The proposed approach is implemented and compared with the classical NH∞ filter using the error covariances calculated from the true errors. Satisfactory results have been obtained for the estimation of the positions and velocities, and the suitability for real-time implementation has been maintained.

Acknowledgments

This study is supported by a grant from the National Natural Fund of China, Grant No. 61375082.

Author Contributions

Fariz Outamazirt designed the study and directed the implementation of the FANH∞ filter with automatic tuning of the linearization error bounds using the fuzzy inference system and tuning of the H∞ bound based on an estimated bias, including the validation of the new filter for the SINS/GPS fusion and a comparison with the classical Nonlinear H filter. This research is part of my PhD research under the supervision of Fu Li, Lin Yan and Abdelkrim Nemra, who also provided technical oversight and valuable suggestions for the technical review and correction of this paper.

Conflicts of Interest

The author declares no conflicts of interest.

References

  1. Nemra, A. Robust Airborne 3D Visual Simultaneous Localisation and Mapping. Ph.D. Thesis, Cranfield University, Cranfield, UK, 2010. [Google Scholar]
  2. Zhou, J.; Yang, Y.; Zhang, J.; Edwan, E.; Loffeld, O.; Knedlik, S. Tightly-Coupled INS/GPS Using Quaternion-Based Unscented Kalman Filter. Proceedings of International Conference AIAA Guidance, Navigation and Control, Portland, OR, USA, 8–11 August 2011; pp. 1–14.
  3. Nemra, A.; Aouf, N.; Tsourdos, A.; White, B. Robust Nonlinear Filtering for INS/GPS UAV Localization. Proceedings of IEEE International Conference on Control and Automation, Ajaccio, France, 25–27 June 2008; pp. 695–702.
  4. Petersen, I.R.; Savkin, A.V. Robust Kalman Filtering for Signals and Systems with Large Uncertainties; Springer: New York, NY, USA, 1999. [Google Scholar]
  5. Einicke, G.A.; White, L.B. Robust Extended Kalman Filtering. IEEE Trans. Signal Process. 1999, 47, 2596–2599. [Google Scholar]
  6. Shaked, U.; Berman, N. H∞ Nonlinear Filtering of Discrete-Time Process. IEEE Trans. Signal Process. 1995, 43, 2205–2209. [Google Scholar]
  7. Zhang, W.; Chen, B.S.; Tseng, C.S. Robust H∞ Filtering for Nonlinear Stochastic Systems. IEEE Trans. Signal Process. 2005, 53, 589–598. [Google Scholar]
  8. Xie, L.; de Souza, C.E.; Wang, Y. Robust Filtering for a Class of Discrete-Time Uncertain Nonlinear Systems: An H∞ Approach. Int. J. Robust. Nonlinear Control 1996, 6, 297–312. [Google Scholar]
  9. Seo, J.; Yu, M.J.; Park, C.G.; Lee, J.G. An Extended Robust H∞ Filter for Nonlinear Uncertain Systems with Constraints. Proceedings of IEEE Conference on Decision and Control, Seville, Spain, 12–15 December 2005; pp. 1935–1940.
  10. Einicke, G.A.; White, L.B. The Extended H∞ Filter—A Robust EKF. Proceedings of IEEE International Conference on Acoustics, Speech, and Signal Processing, Adelaide, Australia, 19–22 April 1994; pp. 181–184.
  11. Xiong, K.; Zhang, H.; Liu, L. Adaptive Robust Extended Kalman Filter for Nonlinear Stochastic Systems. J. IET Control Theory A 2008, 2, 239–250. [Google Scholar]
  12. Rönnbäck, S. Developement of a INS/GPS Navigation Loop for an UAV. Master's Thesis, Lulea University of Technology, Lulea, Sweden, 2000. [Google Scholar]
  13. Nemra, A.; Aouf, N. Robust INS/GPS Sensor Fusion for UAV Localization Using SDRE Nonlinear Filtering. IEEE Sens. J. 2010, 10, 789–798. [Google Scholar]
  14. Titterton, D.; Weston, J.L. Strapdown Inertial Navigation Technology, 2nd ed.; IET: Stevenage, UK, 2004. [Google Scholar]
  15. Siouris, G.M. Aerospace Avionics Systems: A Modern Synthesis; Academic Press: New York, NY, USA,, 1993. [Google Scholar]
  16. Grewal, M.S.; Weill, L.R.; Andrews, A.P. Global Positioning Systems, Inertial Navigation, and Integration, 2nd ed.; Wiley: New Jersey, NJ, USA, 2007. [Google Scholar]
  17. Pratt, T.; Bostian, C.; Allnutt, J. Satellite Communications, 2nd ed.; Wiley Student Edition: New Delhi, India, 2006. [Google Scholar]
  18. Maybeck, P.S. Stochastic Models, Estimation and Control; Academic Press Inc: Waltham, MA, USA, 1979. [Google Scholar]
  19. Grover, R.; Hwang, P.Y.C. Introduction to Random Signals and Applied Kalman Filtering; Wiley: New York, NY, USA, 1997. [Google Scholar]
  20. Simon, D. Optimal State Estimation: Kalman, H∞, and Nonlinear Approaches; Wiley: New Jersy, NJ, USA, 2006. [Google Scholar]
Figure 1. 3D reference frame geometry.
Figure 1. 3D reference frame geometry.
Sensors 14 17600f1 1024
Figure 2. Aided SINS/GPS system configuration.
Figure 2. Aided SINS/GPS system configuration.
Sensors 14 17600f2 1024
Figure 3. SINS/GPS integration based on a Fuzzy Adaptive Nonlinear H∞ filter.
Figure 3. SINS/GPS integration based on a Fuzzy Adaptive Nonlinear H∞ filter.
Sensors 14 17600f3 1024
Figure 4. Estimation of the position X.
Figure 4. Estimation of the position X.
Sensors 14 17600f4 1024
Figure 5. Estimation of the position Y.
Figure 5. Estimation of the position Y.
Sensors 14 17600f5 1024
Figure 6. Estimation of the position Z.
Figure 6. Estimation of the position Z.
Sensors 14 17600f6 1024
Figure 7. Estimation of the velocity following the North axis.
Figure 7. Estimation of the velocity following the North axis.
Sensors 14 17600f7 1024
Figure 8. Estimation of the velocity following the East axis.
Figure 8. Estimation of the velocity following the East axis.
Sensors 14 17600f8 1024
Figure 9. Estimation of the velocity following the Down axis.
Figure 9. Estimation of the velocity following the Down axis.
Sensors 14 17600f9 1024
Figure 10. SINS/GPS 3D trajectory estimation.
Figure 10. SINS/GPS 3D trajectory estimation.
Sensors 14 17600f10 1024
Figure 11. Error covariance in x-axes.
Figure 11. Error covariance in x-axes.
Sensors 14 17600f11 1024
Figure 12. Error covariance in y-axes.
Figure 12. Error covariance in y-axes.
Sensors 14 17600f12 1024
Figure 13. Error covariance in z-axes.
Figure 13. Error covariance in z-axes.
Sensors 14 17600f13 1024
Figure 14. Velocity error covariance in x-axes.
Figure 14. Velocity error covariance in x-axes.
Sensors 14 17600f14 1024
Figure 15. Velocity error covariance in y-axes.
Figure 15. Velocity error covariance in y-axes.
Sensors 14 17600f15 1024
Figure 16. Velocity error covariance in z-axes.
Figure 16. Velocity error covariance in z-axes.
Sensors 14 17600f16 1024
Figure 17. Error covariance in x-axes using the true error.
Figure 17. Error covariance in x-axes using the true error.
Sensors 14 17600f17 1024
Figure 18. Error covariance in y-axes using the true error.
Figure 18. Error covariance in y-axes using the true error.
Sensors 14 17600f18 1024
Figure 19. Error covariance in z-axes using the true error.
Figure 19. Error covariance in z-axes using the true error.
Sensors 14 17600f19 1024
Figure 20. Velocity error covariance in x-axes using the true error.
Figure 20. Velocity error covariance in x-axes using the true error.
Sensors 14 17600f20 1024
Figure 21. Velocity error covariance in y-axes using the true error.
Figure 21. Velocity error covariance in y-axes using the true error.
Sensors 14 17600f21 1024
Figure 22. Velocity error covariance in z-axes using the true error.
Figure 22. Velocity error covariance in z-axes using the true error.
Sensors 14 17600f22 1024
Table 1. Comparison of the standard deviation between the EKF, NH∞ and FANH∞ filters.
Table 1. Comparison of the standard deviation between the EKF, NH∞ and FANH∞ filters.
σx(m)σy(m)σz(m)
EKF7.791925.00344.1430
NH1.96771.82953.2783
FANH0.82450.76591.3944
Table 2. Comparison of the computation time between the NH∞ and FANH∞ filters.
Table 2. Comparison of the computation time between the NH∞ and FANH∞ filters.
NHFANH
Required time for 100 iterations (s)0.02941.4849
Frequency (Hz)3401.367.56

Share and Cite

MDPI and ACS Style

Outamazirt, F.; Li, F.; Yan, L.; Nemra, A. Autonomous Navigation System Using a Fuzzy Adaptive Nonlinear H∞ Filter. Sensors 2014, 14, 17600-17620. https://doi.org/10.3390/s140917600

AMA Style

Outamazirt F, Li F, Yan L, Nemra A. Autonomous Navigation System Using a Fuzzy Adaptive Nonlinear H∞ Filter. Sensors. 2014; 14(9):17600-17620. https://doi.org/10.3390/s140917600

Chicago/Turabian Style

Outamazirt, Fariz, Fu Li, Lin Yan, and Abdelkrim Nemra. 2014. "Autonomous Navigation System Using a Fuzzy Adaptive Nonlinear H∞ Filter" Sensors 14, no. 9: 17600-17620. https://doi.org/10.3390/s140917600

Article Metrics

Back to TopTop