Next Article in Journal
Vision-Based SLAM System for Unmanned Aerial Vehicles
Next Article in Special Issue
A Novel Digital Closed Loop MEMS Accelerometer Utilizing a Charge Pump
Previous Article in Journal
A Novel Semi-Supervised Electronic Nose Learning Technique: M-Training
Previous Article in Special Issue
An Anchor-Based Pedestrian Navigation Approach Using Only Inertial Sensors
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Particle Filter with Novel Nonlinear Error Model for Miniature Gyroscope-Based Measurement While Drilling Navigation

Marine Navigation Research Institute, College of Automation, Harbin Engineering University, No. 145 Nan Tong Street, Harbin 150001, China
*
Author to whom correspondence should be addressed.
Sensors 2016, 16(3), 371; https://doi.org/10.3390/s16030371
Submission received: 4 January 2016 / Revised: 8 March 2016 / Accepted: 10 March 2016 / Published: 15 March 2016
(This article belongs to the Special Issue Inertial Sensors and Systems 2016)

Abstract

:
The derivation of a conventional error model for the miniature gyroscope-based measurement while drilling (MGWD) system is based on the assumption that the errors of attitude are small enough so that the direction cosine matrix (DCM) can be approximated or simplified by the errors of small-angle attitude. However, the simplification of the DCM would introduce errors to the navigation solutions of the MGWD system if the initial alignment cannot provide precise attitude, especially for the low-cost microelectromechanical system (MEMS) sensors operated in harsh multilateral horizontal downhole drilling environments. This paper proposes a novel nonlinear error model (NNEM) by the introduction of the error of DCM, and the NNEM can reduce the propagated errors under large-angle attitude error conditions. The zero velocity and zero position are the reference points and the innovations in the states estimation of particle filter (PF) and Kalman filter (KF). The experimental results illustrate that the performance of PF is better than KF and the PF with NNEM can effectively restrain the errors of system states, especially for the azimuth, velocity, and height in the quasi-stationary condition.

Graphical Abstract

1. Introduction

Horizontal drilling (HD), especially reentry multilateral horizontal well drilling (RMHWD), receives considerable attention because it provides great economic value in the oil and gas industry. The RMHWD technology was originally proposed in an industry consortium of operators and service companies in 1997 [1] and RMHWD can significantly increase the production of oil and gas by extending the contact areas between oil and gas reservoirs and the well drilling equipment and by revisiting the existing wellbores [2]. RMHWD is also readily available under challenging drilling sites such as offshore zones, mountain areas, and downtown centers [3]. The branches of the drill pipe in RMHWD radiate from the main wellbore to the targeted reservoir sections [4]. The high pressure waterjet drilling technology promotes the development of RMHWD since the conventional large rotary drill bit can be replaced by a small-diameter waterjet drill bit. The conventional measurement-while-drilling (MWD) tool combines three-axis gyroscopes and three-axis magnetometers to provide the attitude (tool face, inclination, and azimuth) of the drill bit. However, the performance of the MWD tools would deteriorate under the strong magnetic interference caused by the following factors: (1) flow of currents in the atmosphere and moving of solar wind [5]; (2) existing drilling fluid and debris [6,7]; (3) ferromagnetic deposits in the proximity of bottom hole assembly (BHA) [8]. Non-magnetic drill collars can effectively eliminate the magnetic disturbance; however, the high cost, high weight, and weak fracture drill collars fail to be widely used.
Alternatively, gyroscope-based MWD (GWD) tools can continuously provide the attitude, velocity, and position of the drill bit regardless of the strong magnetic interferences. GWD tools with pure strapdown inertial navigation algorithm were proposed in [9,10] and the tools can save considerable rig time and remove the blind during the kickoff [11]. The size of the fiber optic gyroscope or the laser optic gyroscope limits their application to the surveying of downhole drilling. The emergence of a low-cost, small-size, and high-performance MEMS sensor brings the gyroscopes to the small-diameter RMHWD. The MGWD device with two-axis gyroscopes and three-axis accelerometers in the application of small-diameter space (less than 24 millimeters) was proposed in [12], in which the angular rate (Y-axis) of MGWD tools is calculated by the accelerometers in the horizontal plane when the drilling equipment is under quasi-stationary conditions. The MGWD system can provide high-precision navigation solutions in short-term [13] and can perform real-time data transmission between the MGWD tools and the ground operation center. However, the integration calculation within resolving the mechanization of navigation solutions accumulates large errors because of biases of gyroscopes and accelerometers. The errors of inertial sensors are composed of two parts: deterministic errors and stochastic errors [14]. The deterministic errors can partially be reduced by the calibration approach. Therefore, the residual of deterministic errors and the stochastic errors are main error sources of inertial sensors. To sum up, the problems should be solved for MGWD system are the elimination of the residual of deterministic errors and stochastic errors.
The stochastic errors of inertial sensors can be modeled by the first-order Gaussian–Markov (GM) model or the high-order autoregressive (AR) model [15]. The Levenberg–Marquardt iterative least squares can fit the nonlinear parametric model of stochastic errors as well [16]. The traditional error models of the MGWD system, such as the Phi-angle or Psi angle model, are based on the assumption that the attitude errors are small enough that the DCM can be simplified by the small-angle attitude errors. The linear modified error model for large heading uncertainty was proposed in [17] and the model of moving alignment with large errors was put forward in [18]. In the application of the Kalman filter (KF), both error models neglect the high-order error terms that may introduce errors when the attitude errors are large. In addition, the system noises and the observation noises are not Gaussian for MGWD system in sophisticated downhole drilling environments (high temperature and high pressure). Therefore, the KF is suboptimal compared with the particle filter (PF), which is the recursive approximation of the posterior probability density function (pdf) with particles and weights [19]. The conventional in-drilling alignment (IDA) approaches include the zero velocity update (ZUPT) alignment, velocity matching alignment, rotary modulation alignment, etc. The ZUPT alignment can limit the position errors up to 40 m during a 90-min experiment by using a Litton LTN90-100 inertial measurement unit (IMU) [20]. The velocity matching alignment merges velocity from global positioning system (GPS) or other velocity sensors to the filtering for compensating the errors [21]. An IDA approach was introduced to restrict the azimuth error of the drill bit in [22,23]; the azimuth error was reduced 25 times smaller than the conventional magnetometer based MWD tools. The rotary-in-drilling alignment (RIDA) was proposed in terms of the theory of rotary modulation alignment in an inertial navigation system (INS) to minimize the dynamic position errors and the azimuth error of the MWD system [24,25]. However, GPS signals cannot reach to a deep downhole and the size of IDA or RIDA is beyond the dimension requirements of the RMHWD.
This paper proposes a NNEM for the MGWD system under large-angle attitude error conditions. The error matrix of DCM is introduced to represent the attitude errors. Because of the nonlinearity of the system state space model (SSM), the PF is selected as the state estimation approach. The body frame is the right, forward, and up direction of the MGWD system and the navigation frame is the north, east, and down direction in this paper.
In Section 2, the NNEM of the MGWD system is proposed. Section 3 and Section 4 introduce the recursive Bayesian estimation theory and PF algorithm, respectively. Results and experiments are explained in Section 5. Eventually, conclusions are presented in Section 6.

2. NNEM of the MGWD System

The error model of the strapdown inertial navigation system (SINS), based on the discrete time differential equation and the error model, plays a fundamental role in the estimation of system states. Conventional linear error models (LEM) of SINS, such as the Phi-angle model, the Psi-angle model [26,27], and the quaternion error model [28] are widely used in aerospace and marine navigation. The Phi-angle error model analyzes the SINS in the true navigation frame while the Psi-angle model is performed in the computer frame. In this paper, the Psi-angle model is selected for the states estimation of KF while the error model in [29] is used as the NEM for the states estimation of the PF.
The derivation of a linear model by the perturbation method alone can be implemented in light of the assumption that the attitude errors are small enough. The initial alignment of the MGWD system cannot provide an accurate attitude because of the low performance of the MEMS sensors and the sophisticated downhole drilling environments. Therefore, this paper proposes an accurate NNEM of the MGWD system under large-angle attitude error conditions.
The key variable for the derivation of the SINS error model is the rotation vector, which is the eigenvector of the DCM associated with eigenvalue 1. The eigenvector of the DCM can be expressed as follows [30,31]:
( R b n I ) Φ = 0
where R b n is the DCM from the body frame to the navigation frame ,   Φ is the rotation vector, and I is a 3 × 3 identity matrix. The rotation vector is proposed in [32], and the relationship between rotation vector and DCM can be expressed as:
R b n = I + sin Φ Φ ( Φ × ) + 1 cos Φ Φ 2 ( Φ × ) 2
where ( Φ × ) is the skew symmetric matrix of Φ , i.e.,:
( Φ × ) = [ 0 Φ z Φ y Φ z 0 Φ x Φ y Φ x 0 ]
where Φ x ,   Φ y , and Φ z are the components of Φ projected in X-axis, Y-axis, and Z-axis.
The magnitude of Φ equals:
Φ = ( Φ T Φ ) 1 / 2
So far, the problem of seeking an attitude solution equates to seeking a solution for the rotation vector. The derivation of the kinematic equation of rotation vector was reviewed in [33], and the conventional differential equation of rotation vector was given by [34]:
Φ ˙ = ( I + 1 2 ( Φ × ) + 1 Φ 2 ( 1 Φ sin Φ 2 ( 1 cos Φ ) ) ( Φ × ) 2 ) ω nb b
where ω nb b is the angular rate of the body frame with respect to the navigation frame resolved in the body frame.
This section reviews the nonlinear error model of MGWD according to [27], in which the attitude error model is derived according to the linear quaternion error model. The attitude errors are defined in terms of the rotation vector:
Φ = ( δ ϕ , δ θ , δ ψ )
where δ ϕ ,   δ θ ,  and  δ ψ are the roll error, pitch error, and azimuth error. The NNEM of the attitude can be expressed as follows:
Φ ˙ = ( I c n Φ Φ T ) 1 ( ω in n × Φ 1 2 s n ( R b n ω ib b δ ω in n ) )
where c n and s n are defined parameters that can be expressed as:
c n = cos ( Φ n 2 ) 1
s n = 1 Φ n sin ( Φ n 2 )
Φ n = δ ϕ 2 + δ θ 2 + δ ψ 2
where ω ib b is the angular rate obtained from the gyroscope, ω in n is the angular rate of the navigation frame with respect to the inertial frame resolved in the navigation frame, and ω in n can be expressed as:
ω in n = ω ie n + ω en n
where ω ie n is the Earth rotation rate in the navigation frame and ω ie n can be written as follows:
ω ie n = [ ω ie cos φ 0 ω ie sin φ ] T
where ω ie is the Earth rotation rate 7.292115 × 10 5 rad / s 15.041067 ° / h ; φ is the latitude; ω en n is the angular rate of the navigation frame with respect to the Earth frame resolved in the navigation frame; and ω en n can be written as:
ω en n = [ V E R N + h V N R M + h V E tan φ R N + h ] T
where V E  and  V N represent the east velocity and north velocity, respectively, in the navigation frame; h is the ellipsoidal height; R N  and  R M are the radii of curvature in the meridian and the prime vertical, respectively; and R N R M can be expressed as follows [35]:
R N = R ( 1 e 2 sin 2 φ ) 1 / 2
R M = R ( 1 e 2 ) ( 1 e 2 sin 2 φ ) 3 / 2
where R e are the semi-major axis and linear eccentricity of the reference ellipsoid, respectively, in which R = 6378137 m and e = 0.0818191908426 .
The output errors of accelerometers and gyroscopes ( δ f ib b and δ ω ib b ) can be expressed as [36]:
δ ω ib b = [ Δ SF x , g Δ δ xz , g Δ δ xy , g Δ δ yz , g Δ SF y , g Δ δ yx , g Δ δ zy , g Δ δ zx , g Δ SF z , g ] ω ib b + [ ϵ x , g ϵ y , g ϵ z , g ]
δ f ib b = [ Δ SF x , a Δ δ xz , a Δ δ xy , a Δ δ yz , a Δ SF y , a Δ δ yx , a Δ δ zy , a Δ δ zx , a Δ SF z , a ] f ib b + [ ϵ x , a ϵ y , a ϵ z , a ]
where Δ SF x , g and Δ SF z , g are the scale factor errors of X-axis gyroscope and Z-axis gyroscope. Δ SF y , g is defined as the scale factor error of a virtual gyroscope along the Y-axis. Δ δ xy , g ,   Δ δ xz , g ,   Δ δ yz , g ,   Δ δ yx , g ,   Δ δ zy , g , and Δ δ zx , g are non-orthogonal gyroscope errors along the X-axis, Y-axis, and Z-axis. Δ SF x , a ,   Δ SF y , a , and Δ SF z , a are the scale factor errors of the X-axis accelerometer, Y-axis accelerometer, and Z-axis accelerometer, respectively. Δ δ xy , a ,   Δ δ xz , a ,   Δ δ yz , a ,   Δ δ yx , a ,   Δ δ zy , a ,  and  Δ δ zx , g are non-orthogonal acceleration errors along the X-axis, Y-axis, and Z-axis. ϵ x , g , ϵ y , g , ϵ z , g and ϵ x , a , ϵ y , a , ϵ z , a are the angular drift errors of gyroscopes and drift errors of accelerometers along the X-axis, Y-axis, and Z-axis, respectively.
Through differentiating the Equations (11) and (12), δ ω in n can be written as [37]:
δ ω in n = δ ω ie n + δ ω en n
δ ω ie n = [ ω ie sin φ δ φ 0 ω ie cos φ δ φ ]
δ ω en n = [ 1 R N + h δ V E V E ( R N + h ) 2 δ h 1 R M + h δ V N + V N ( R M + h ) 2 δ h tan φ R N + h δ V E V E sec 2 φ R N + h δ φ + V E tan φ ( R N + h ) 2 δ h ]
where δ V E and   δ V N are the errors of east velocity and north velocity, respectively; δ φ and δ h are the errors of latitude and height, respectively; and δ ω ie n and δ ω en n are the errors of ω ie n and ω en n , respectively.
The conventional velocity update equation can be written as follows [21]:
V ˙ n = R b n f ib b ( 2 ω ie n + ω en n ) V n + g n
where V n is the velocity in the navigation frame; f ib b is the output of accelerometers; and g n is the gravity expressed in the navigation frame (the model of g n is proposed in [38]).
The velocity error model can be obtained by perturbing Equation (20), and the DCM can be approximated by the following expression:
R ˜ n b = R n b ( I Ξ )
where the designator ~ in the above variables represents variables with errors. Ξ is a skew symmetric matrix of attitude error and Ξ is given by:
Ξ = [ 0 δ ψ δ θ δ ψ 0 δ ϕ δ θ δ ϕ 0 ]
However, the above equation may introduce errors if large attitude errors exist, so the error matrix of DCM ( Δ R b n ) is introduced for the derivation of velocity error equation. The DCM in Equation (21) can be replaced by:
R ˜ n b = R n b R n b Δ R b n
The velocity update equation with error interferences can be written as:
V ˜ ˙ n = R ˜ b n f ˜ ib b ( 2 ω ˜ ie n + ω ˜ en n ) V ˜ n + g ˜ n
The velocity errors ( δ V ˙ n ) can be obtained by the difference between Equations (20) and (24), ignoring the second-order error product R n b Δ R b n δ f ib b and ( 2 δ ω ie n + δ ω en n ) δ V n , yields:
δ V ˙ n = V ˜ ˙ n V ˙ n =  R b n δ f ib b R b n Δ R b n f ib b ( 2 ω ie n + ω en n ) δ V n ( 2 δ ω ie n + δ ω en n ) V n + δ g n
The only unknown parameter in Equation (25) is Δ R b n , which can be obtained in terms of Φ , and the relationship between Δ R b n and Φ can be expressed as [27]:
Δ R b n = 2 s n 2 ( ( δ θ ) 2 + ( δ ψ ) 2 ) s n ( 1 + c n ) δ ψ + s n 2 δ ϕ δ θ s n ( 1 + c n ) δ θ + s n 2 δ ϕ δ ψ s n ( 1 + c n ) δ ψ + s n 2 δ ϕ δ θ s n 2 ( ( δ ϕ ) 2 + ( δ ψ ) 2 ) s n ( 1 + c n ) δ ϕ + s n 2 δ θ δ ψ s n ( 1 + c n ) δ θ + s n 2 δ ϕ δ ψ s n ( 1 + c n ) δ ϕ + s n 2 δ θ δ ψ s n 2 ( ( δ ϕ ) 2 + ( δ θ ) 2 )
The velocity error equation is obtained by inserting Equation (26) into Equation (25). There is no relationship between the model position error ( δ P ˙ ) and the attitude, so the position error model is still linear as [39]:
δ P ˙ = [ δ V N R M + h V N ( R M + h ) 2 δ h δ V E ( R N + h ) cos φ V E δ h ( R N + h ) 2 cos φ V E δ φ ( R N + h ) cos 2 φ δ V D ]
where δ V D is the error of the down velocity.
The nonlinear error model of the MGWD system can be achieved through Equations (7), (25) and (27). The observation equation is the linear ZUPT equation, which is expressed as follows:
Z k = HX k + v k
where Z k is the difference between the estimate state ( V N ,   V E ,   V D ,   φ ,   λ ,  h ) and the zero velocity and zero position ( V N , 0 ,   V E , 0 ,   V D , 0 ,   φ 0 ,   λ 0 ,   h 0 ):
Z k = [ V N V N , 0 V E V E , 0 V D V D , 0 φ φ 0 λ λ 0 h h 0 ]
H = [ H 11 H 12 H 13 H 21 H 22 H 23 ]
where λ is the longitude and V N , 0 ,   V E , 0 ,   V D , 0 ,   φ 0 ,   λ 0 ,  and  h 0 represent the zero velocity and zero position. H 12 ,   H 13 ,   H 21 ,  and  H 23 are a 3 × 3 zero matrix; H 11 ,   H 22 are a 3 × 3 identity matrix.

3. Recursive Bayesian Estimation

In this section, we briefly review the theory of the recursive Bayesian estimation. The system is generally modeled as an SSM, which includes a system equation and an observation equation in the discrete time domain; the SSM can be written as follows:
x k = f k 1 ( x k 1 , ϖ k 1 )
z k = h k ( x k ,  v k )
where f k 1 : n × m n is the system nonlinear function; ϖ k 1 m is a zero mean, white noise with known pdf p ( ϖ k 1 ) ; x k and x k 1 are the system state vectors at present time k and previous moment k-1; z k n is the measurement from external reference; h k : n × r p is the measurement function; and v k r is a zero mean, white noise with known pdf p ( v k ) . Figure 1 illustrates the recursive Bayesian estimation model in graphical form [40,41].
A more general system model (Markov model) and observation model corresponding to the Equations (31) and (32) can be given by the following expressions:
x k ~ p ( x k | x k 1 )
z k ~ p ( z k | x k )
The definition of SSM in Equations (33) and (34) are based on the prior function and likelihood function. Both models are equivalent, but the general model is more convenient for the theoretical derivation.
The assumptions of recursive Bayesian estimation are that (1) the state vector x k is a hidden Markov process with initial distribution p ( x 0 ) and x k is independent of the other state vectors except xk−1, i.e., the conditional pdf p ( x k | x 0 : k 1 ) = p ( x k | x k 1 ) ; (2) the measurement process z k only depends upon x k , i.e., the conditional pdf p ( z k | x k ,  z 1 : k 1 ) = p ( z k | x k ) .
To sum up, the evaluation of the Bayesian estimation is given by the following steps.
(1)
Prediction: evaluating the prior pdf p ( x k | z 1 : k 1 ) by the knowledge of the observation before time k in the light of the Chapman–Kolmogorov equation [42]:
p ( x k | z 1 : k 1 ) = p ( x k | x k 1 ) p ( x k 1 | z 1 : k 1 ) dx k 1
where the pdf of initial state p ( x 0 | z 0 ) can be assigned by p ( x 0 | z 0 ) = p ( x 0 ) . p ( x k | x k 1 ) is the prior distribution, which is given by [43]:
p ( x k | x k 1 ) = δ ( x k f k 1 ( x k 1 , w k 1 ) ) p ( ϖ k 1 ) d ϖ k 1
where δ ( ) is the Dirac delta function.
(2)
Updating: the posterior pdf p ( x k | z 1 : k ) can be updated with the new measurement z k at time k in terms of the Bayes rule as follows [44]:
p ( x k | z 1 : k ) = p ( z k | x k ) p ( x k | z 1 : k 1 ) p ( z k | z 1 : k 1 )
where p ( z k | x k ) is the likelihood function, which is written by the following equation [43]:
p ( z k | x k ) = δ ( y k h k ( x k ,   v k ) ) p ( v k ) dv k
(3)
State estimation: once the posterior is obtained, the estimation of state ( x ^ k ) and the covariance matrix of estimation error ( P x ^ k ) are given by [45]:
x ^ k = E ( x k | z 1 : k ) = x k p ( x k | z 1 : k ) dx k
P x ^ k = E ( x ˜ k x ˜ k T ) = x ˜ k x ˜ k T p ( x k | z 1 : k ) dx k
where x ˜ k = x k x ^ k is the estimation error and E ( ) is the expectation of the random variables.

4. PF Algorithm

Because the function p ( z k | z 1 : k 1 ) in Equation (37) cannot typically be computed analytically, sequential Monte Carlo (SMC) approximation, the key idea of the PF, was proposed for the hidden states estimation of the dynamic systems [46,47]. The PF uses a finite set of weighted particles or samples to reconstruct the posterior pdf p ( x 0 : k | z 1 : k ) of the state vectors regardless of the nonlinear or non-Gaussian systems [48,49]. The implementation of the PF can be summarized in three main steps: sequential importance sampling (SIS), resampling, and roughening. The SIS plays a fundamental rule in the iteration of the PF since searching proper importance function decides the success of PF. Resampling aims at alleviating the particles’ or samples’ degeneracy and the roughing approach can be utilized to avoid the particles’ or samples’ impoverishment.

4.1. SIS Algorithm

The SIS algorithm steps from the literature [50,51]. The basic idea of SIS is the selection of particles or samples with weights to represent the complicated high dimensional distributions [52]. The posterior pdf p ( x 0 : k | z 1 : k ) is approximated by the random particles or samples and weights { x 0 : k i , w k ( i ) | i = 1 , 2 , N } at time k as:
p ( x 0 : k | z 1 : k ) = i = 1 N w k ( i ) δ ( x 0 : k x 0 : k i )
where N is the number of particles and x 0 : k is the system state.
The first task to implement the SIS is the selection of the importance function π ( x 0 : k | z 1 : k ) , which is proportional of the posterior pdf p ( x 0 : k | z 1 : k ) and is easy to draw samples compared with  p ( x 0 : k | z 1 : k ) . The weights can be updated in terms of the following equation:
w k ( i ) = p ( x 0 : k | z 1 : k ) p ( z 1 : k ) π ( x 0 : k | z 1 : k ) p ( x 0 : k | z 1 : k ) π ( x 0 : k | z 1 : k )
Generally, the importance function is selected such that [53]:
π ( x 0 : k | z 1 : k ) = π ( x k | x k - 1 , z k ) π ( x 0 : k - 1 | z 1 : k )
Note that the Equation (41) can be factored as following equation according to the Bayesian rule [54]:
p ( x 0 : k | z 1 : k ) p ( z k | x 0 : k ) p ( x k | x k 1 ) p ( x 0 : k 1 | z 1 : k 1 )
Therefore, the weights can be updated by substituting Equations (43) and (44) into Equation (42), yielding:
w k ( i ) w k 1 ( i ) p ( z k | x k i ) p ( x k i | x k 1 i ) π ( x k i | x k 1 i , z k )
where x k i is the variable obtained by the evaluation of  x k 1 i in the system model and x k 1 i is the samples drawn from the importance function π ( x k i | x k 1 i , z k ) , which is related to the previous state x k 1 i and current observation z k . In the application of the MGWD system, the estimation of the current state is more important than the previous states, so Equation (41) can be rewritten as:
p ( x k | z 1 : k ) = i = 1 N w k ( i ) δ ( x k x k i )
As indicated in Equations (45) and (46), the posterior pdf depends on the likelihood function, the priori pdf, and the importance function. Since the likelihood function and the priori pdf can be obtained in terms of the SSM, the choice of importance function is essential for PF. The optimal function, the likelihood function, and the priori function are the components of the importance function [54].
The optimal function p ( x k i | x k 1 i , z k ) was proposed as the importance function in [41]:
p ( x k i | x k 1 i , z k ) = p ( x k | x k 1 i )
Substituting Equation (47) into Equation (45) yields:
w k ( i ) w k 1 ( i ) p ( z k | x k 1 i )
The drawbacks of using optimal importance function are: (1) it is difficult to draw samples from the optimal function p ( x k i | x k 1 i , z k ) ; (2) it needs the integration calculation to update the weights. The optimal function can be factorized as the following format based on the Bayesian rule:
p ( x k i | x k 1 i , z k ) = p ( z k | x k i ) p ( x k i | x k 1 i ) p ( z k | x k 1 i )
As indicated in Equation (49), p ( x k i | x k 1 i , z k ) p ( z k | x k i ) if the likelihood function p ( z k | x k i ) is more noisy and it is integral in x k i [55]. In this case, the importance function can be presented by the likelihood function, namely:
π ( x k i | x k 1 i , z k ) = p ( z k | x k i )
Then, the weight in Equation (45) can be updated by the following equation:
w k ( i ) w k 1 ( i ) p ( x k i | x k 1 i )
However, the likelihood function as the importance function can only be used in the high signal-to-noise ratio (SNR) case. In this paper, the priori function is selected as the importance function because of the tradeoff between computational complexity and the feasibility of implementation. The importance function is written by:
π ( x k i | x k 1 i , z k ) = p ( x k i | x k 1 i )
Then, the weights can be updated by:
w k ( i ) w k 1 ( i ) p ( z k | x k i )
The above equation shows that the weights only depend on the previous weights and the likelihood function, which are available from the knowledge of the observation equation and the pdf of the observation noise. In this application, we assume that the measurement noise of the MGWD system is additive, Gaussian white noise, so the likelihood function can be evaluated in a simple way [56]:
P ( z k x k ( i ) ) 1 2 π | R | 1 / 2  exp ( ( z k h ( x k i ) ) T R 1 ( z k h ( x k i ) ) )
where R is the covariance matrix of measurement noise v k .
The normalization of the particle weights are performed to guarantee the sum of the particle weights equal to 1, and the normalization of the weights can be expressed as follows:
w k ( i ) = w k ( i ) i = 1 N w k ( i )
Under the premise that the initial pdf p ( x 0 | z 0 ) is known, drawing particles  x 0 i ~ p ( x 0 | z 0 ) ,  where i = 1 , 2 , N , as:
x k 1 i = f k 1 ( x 0 i , ϖ 0 i )
where x 0 i is the initial particles and ϖ 0 i is the noise vector which is drawn from the pdf of system noise p ( ϖ k 1 ) . The initial weights are given by:
w 0 i = p ( z 0 | x 0 i )
The SIS algorithm can only be implemented in special cases because the variance of the importance weights only increase over time; eventually, they give rise to particle degeneracy. Particle degeneracy means that the updating particles are useless for the approximation of a posterior pdf. In order to solve the particles degeneracy problem, a resampling method is described in next section.

4.2. Resampling Algorithm

The PF would suffer from the particle degeneracy without a resampling algorithm. Figure 2 shows the principle of the particle resampling.
The key of the resampling algorithm is that particles with large weights are replicated and particles with small weights are discarded [57]. The effective sample size N eff is an indicator of the degree of the particles’ degeneracy and a metric of employing the particles’ resampling. N eff is provided by the following equation [58]:
N eff = N 1 + N 2 var ( w k ( i ) ) 1 i = 1 N ( w k ( i ) ) 2
where v a r ( w k ( i ) ) is the variation of the weight.
The particles should be resampled if N eff is less than resample threshold ( N th ) , which equals 4 N / 5 in this paper. Equation (58) shows that N eff approaches 1 if the particles are severely degenerated; on the other hand, N eff approaches N if the particles have equal weight ( 1 / N ) . The number of the resampled particles is not necessarily the same as the propagated particles  N ; however, the number of particles can be the same for computational convenience. Therefore, the total resampling particles are unchanged, still N, so the resampled particles have the same weight ( 1 / N ) .
There are several ways to implement the resampling algorithm such as systematic resampling [59], multinomial resampling [60], residual resampling [61], etc. The resampling strategy in PF is sampling with replacement, that is, the particles drawn from the box will be replaced after the decimation. In this paper, the multinomial resampling approach is selected to alleviate particles’ degeneracy. The multinomial resampling can be considered as a series of Bernoulli trials. N random samples u ( n ) ,  n = 1 , 2 , N are generated from the uniform distribution over ( 0 , 1 ] and the probabilities of resampling the particles is the same as u ( n ) when the following inequality is satisfied:
i = 1 N 1 w k ( i ) < u ( n ) i = 1 N w k ( i )
Then, the nth particle x k ( n ) with the nth weight is the selection of the new samples or particles x k ( i ) of the resampling.

4.3. Roughing Strategy

The problem of resampling is that only a few particles are drawn, which is also referred to as samples impoverishment. Therefore, the particles lack diversities because the selection may include many repeated particles. In order to address the samples impoverishment problem, the random noise is added to the particles after resampling. The posterior particles x k ( i ) + are written as:
x k ( i ) + = x k ( i ) + ϱ k ( i )
where ϱ k ( i ) is a zero mean random noise.
At this point, the particles after the roughing step can be propagated for the update of the weights and the posterior pdf in the next time cycle. The first two moments of estimation derived from the particles can be approximated by the following equations:
x ^ k = E [ x k ] i = 1 N w k i ( x k ( i ) + )
P x ^ k = E [ ( x k x ^ k ) ( x k x ^ k ) T ] i = 1 N w k i ( x k ( i ) + ) ( x k ( i ) + ) T

5. Results and Discussion

The objectives of the designed experiments are to demonstrate that: (1) the performance of the PF with NEM or NNEM is better than KF with LEM under small-angle attitude error condition (Experiment 1); (2) PF with NNEM can provide more accurate states estimation for the MGWD system with large-angle attitude error (Experiment 2). The configuration of the MGWD device and the details of the experimental data collection are briefly described in the first part of Section 5.

5.1. MGWD Device for Validation of Experimental Results

The MGWD device consists of the azimuth MEMS sensor, the pitch MEMS sensor, and the microcontroller. Figure 3 shows the configuration of the MGWD device. Azimuth MEMS sensor provides the angular rate of the drill bit along the Z-axis while the angular rate along the X-axis is obtained from the pitch MEMS sensor. For implementation of the pure INS algorithm, the angular rate along the Y-axis is evaluated by the specific force obtained from the pitch MEMS sensor [12].
The MEMS sensor (SCC1300-D04, Murata Manufacturing Co., Ltd, Kyoto, Japan) is a combined gyroscope and accelerometer component and the sensor is characterized by low cost, small diameter, and high performance. The microcontroller (CC2538, Texas Instruments, Dallas, TX, USA) is a high-speed System-on-Chip (SoC) combined with ARM cortex-M3 processor. Table 1 and Table 2 provide the technical specification of the MEMS sensor and the microcontroller, respectively.
The types of data communication between the MEMS sensor and microcontroller is the serial peripheral interfaces (SPI) interface with 115,200 bit/s data transmission rate. The data collection software evaluates the navigation solutions with angular rate and specific force received from MGWD device through the universal serial bus (USB) with 20 Hz sample rate.
Figure 4 shows the process of the data collection and the contents of the experiments. The computer continuously reads the angular rate and the specific force of the drill bit from the static MGWD device. Therefore, the zero velocity and zero position are readily available as the reference of experiments, designed in terms of the size of attitude error.
In the experiment, we collect original data from the static MGWD device for the period of 10 min to demonstrate the performance of the PF and the accuracy of the proposed NNEM. Figure 5 shows the original data from two-axis gyroscopes and three-axis accelerometers. The outputs of gyroscopes include the noise and the angular rate of the Earth projected onto the X-axis and Z-axis of the MGWD device. The X-axis and the Y-axis outputs of accelerometers are only the noise since the device is under static condition while the Z-axis output of accelerometer consists of the noise and gravity.

5.2. Experiment 1: Comparison of KF with LEM and PF with NEM under Small-Angle Attitude Error Condition

The aim of Experiment 1 is to confirm that the performance of the PF with NEM is better than the performance of KF with LEM under small-angle attitude error conditions. The assumption of KF is that all the states are Gaussian and the SSM is linear. However, the complicated drilling environments introduce such strong interference to the MGWD device that the linear SSM and Gaussian states are impossible.
The first 50 s are utilized for initial alignment; the results of the initial alignment for roll, pitch, and azimuth are −0.022108 ° , 0.180922 ° , and −10.351435 ° , which are also set as the initial attitude in this experiment. Therefore, the initial attitude error is so small that the DCM can be approximated by the attitude. The rest of parameters related to the KF and PF are given as follows:
  • Initial covariance matrix of system noise: R = diag([0.1,0.1, 0.1,0.1, 0.1, 0.1]);
  • Initial covariance matrix of observation noise: Q = diag([0.1, 0.1, 0.1, 0.1, 0.1, 0.1, 0.1, 0.1, 0.1]);
  • Initial position: latitude 126.6879 ° ; longitude 45.7776 ° ; height 124 m;
  • Initial velocity: 0.
Figure 6 illustrates the initial particles and initial weights.
Figure 7 a1, a2, b1, b2, c1, c2 show the particles of the state errors together with the corresponding weights drawn from the priori pdf { p ( x k i | x k 1 i ) } at time k. The posterior pdf { p ( x k | z k ) } can be evaluated by the Equation (46) after the particles and the corresponding weights are obtained. The number of the particles and weights for each state are 200. The particles and weights are updated at every time circle; meanwhile, the posterior pdf is updated.
Figure 8 presents the evaluation of state density in terms of the updated pdf; the results illustrates that the pdf of states are partially Gaussian. Therefore, the KF is suboptimal since the assumption is that all states are Gaussian in KF while the PF would not be limited by the non-Gaussian assumption.
Figure 9 gives a performance comparison of the KF with LEM and PF with NEM or NNEM under small-angle attitude error. Figure 9 a1, a2 show that both the latitude and the longitude estimated by KF and PF converge to 45.7776 ° and 126.6879 ° , which are the same as the reference values (initial latitude and initial longitude). However, the height estimated by KF is 132.0782 m while the height estimated by PF is 123.9999 m, which is almost the same as the reference height (124 m). Therefore, the NEM or NNEM can restrain the errors of height effectively under small-angle attitude error conditions.
In Figure 9 b1, b2 the north velocity, east velocity, and down velocity estimated by PF are close to zero (0.0002 m/s, 0.0001 m/s, and 0.0001 m/s) while the errors of north velocity, east velocity, and down velocity estimated by KF are up to 0.3702 m/s, 0.2839 m/s, and 2.2953 m/s respectively. Therefore, the PF with NEM or NNEM gives better performance than KF with LEM does for the velocity estimation under small-angle attitude error.
In Figure 9 c1, c2 the roll, pitch, and azimuth of MGWD system estimated by PF with NEM or NNEM largely converge to −0.022125 ° , 0.180922 ° , and −10.353632 ° , respectively, which are the same as the reference points provided by the initial alignment, while the results of pitch and azimuth estimated by KF deviate from the reference values by about 8 ° and 10 ° , respectively. Therefore, the PF with NEM or NNEM can restrain the pitch and azimuth error effectively.

5.3. Experiment 2: Validation of the Performance of NNEM with Large-Angle Attitude Error

The objective of Experiment 2 is the validation of the performance of NNEM with large-angle attitude error. The experimental data used in this section are the same as those in Experiment 1 and the initial parameter settings are also the same as in experiment 1 apart from the initial attitude. The assumption of this experiment is that the initial alignment fails to provide an accurate initial attitude. We set the initial roll, pitch, and azimuth as 0 ° . The experiment is practical since the initial attitude is generally difficult to obtain in the application of downhole drilling.
Figure 10 a1, a2, b1, b2, c1, c2 show the estimation of roll, pitch, and azimuth of the MGWD system and the corresponding estimation errors. The roll, pitch, and azimuth converge to 0.021976 ° , 0.184392 ° , and 9.893302 ° , respectively, which are close to the reference values for initial alignment. The selection of initial attitude has little influence on the convergence of the attitude estimation by PF with NNEM since the roll converges to the reference value at around 320 s, the pitch converges to the reference value at around 180 s, and the azimuth converges to the reference value at around 360 s, as illustrated in Figure 10 a1, b1, and c1. Figure 10 a2, b2, c2 show that the error of roll and error of pitch estimated by PF with both NNEM and NEM are less than 0.0001 ° and 0.001 ° . The error of azimuth estimated by PF with NEM is 2.459532 ° while the estimation error of azimuth with NNEM is 2.5 × 10 5 ° . In addition, the accurate solutions of roll and pitch presented in Figure 10 demonstrate that the error of roll and error of pitch couple with the accuracy of east velocity and north velocity. Therefore, the PF with NNEM can greatly restrain the azimuth error under large-angle latitude error conditions.
Figure 11 a1, a2, b1, b2, c1, c2 illustrate the results of the north velocity, east velocity, and down velocity and the corresponding estimation errors of the MGWD system. The velocity estimated by PF, regardless of NEM or NNEM, apparently converges to zero velocity while the velocity error estimated by PF with NNEM is approximately 10 times smaller than KF with LEM. Therefore, the velocity errors estimated by PF with NNEM can be reduced effectively.
Figure 12 a1, a2, b1, b2, c1, c2 describe the estimation of latitude, longitude, and height of the MGWD system and the corresponding estimation errors. The latitude and longitude estimated by KF with LEM, PF with NEM, and PF with NNEM are almost close to the reference values 45.7776 ° for latitude, 126.6879 ° for longitude. The height estimated by PF with NNEM is 123.9996  m (reference height: 124 m) while the error of height estimated by KF with LEM is about 5  m and the error of height estimated by PF with NEM is approximately 3  m . The results demonstrate that the PF with NNEM can constrain the error growth of height effectively. Table 3 lists the results of Experiment 2.

6. Conclusions

This paper proposes a NNEM for MGWD system under large-angle attitude error conditions. The error of DCM as the intermediate variable is introduced for the derivation of NNEM, which can effectively eliminate the approximation of errors existing in the derivation of conventional NEM. The evaluation of the state density shows that the system states are partially Gaussian, so the KF is suboptimal in this application. PF can improve the estimation performance of nonlinear problems by approximating the posterior pdf with the particles and weights. The PF with NEM gives a better performance than KF with LEM for the estimation of height, velocity, pitch, and azimuth in Experiment 1. The NNEM of the MGWD system provides an accurate estimation of position, velocity, and attitude compared with PF with NEM and KF with LEM in Experiment 2.

Acknowledgments

This project was supported by the Marine Navigation Research Institute.

Author Contributions

The first author, Tao Li, proposed the novel nonlinear error model of the MGWD system and performed the reported experiments. Numerical simulations and data processing were performed by Tao Li and Wang Li. Gannan Yuan supervised the entire work and provided important technical feedback. All three authors have contributed to the writing of the paper.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. PetroWiki. Multilateral wells. Available online: http://petrowiki.org/Multilateral_wells (accessed on 20 December 2015).
  2. Longbotton, J.R.; Cox, D.C.; Gano, J.C.; Welch, W.R.; White, P.M.; Nivens, H.W.; Jacquier, R.C.; Holbrook, P.D.; Frreman, T.A.; Mills, D.H. Multilateral well drilling and completion method and apparatus. European Patent 1,249,574 B1, 27 April 2005. [Google Scholar]
  3. Ledroz, A.G.; Pecht, E.; Cramer, D.; Mintchev, M.P. FOG-based navigation in downhole environment during horizontal drilling utilizing a complete inertial measurement unit: Directional measurement-while-drilling surveying. IEEE Trans. Instrum Meas. 2005, 54, 1997–2006. [Google Scholar] [CrossRef]
  4. Bosworth, S.; EI-Sayed, H.S.; Ismail, G.; Ohmer, H.; Stracke, M.; West, C.; Retnanto, A. Key issues in multilateral technology. Oil Field Rev. 1998, 10, 14–28. [Google Scholar]
  5. Matheson, E.; McElhinney, G.; Lee, R. The first use of gravity MWD in offshore drilling delivers reliable azimuth measurements in close proximity to sources of magnetic interference. In Proceedings of the IADC/SPE Drilling Conference, Dallas, TX, USA, 2–4 March 2004.
  6. Torkildsen, T.; Edvardsen, I.; Fjogstad, A.; Saasen, A.; Amundsen, P.A.; Omland, T.H. Drilling fluid affects MWD magnetic azimuth and wellbore position. In Proceedings of the IADC/SPE Drilling Conference, Dallas, TX, USA, 2–4 March 2004.
  7. Amundsen, P.A.; Ding, S.; Datta, B.K.; Torkildsen, T.; Saasen, A. Magnetic shielding during MWD azimuth measurements and wellbore positioning. Soc. Pet. Eng. 2008, 25, 219–222. [Google Scholar]
  8. Noureldin, A.; Irvine-Halliday, D.; Mintchev, M.P. Accuracy limitations of FOG-based continuous measurement-while-drilling surveying instruments for horizontal wells. IEEE Trans. Instrum. Meas. 2002, 51, 1177–1191. [Google Scholar] [CrossRef]
  9. Aboelmagd, N.; Tabler, H.; Irvine-Halliday, D.; Mintchev, M.P. Quantitative study of the applicability of fiber-optic gyroscopes for MWD borehole surveying. SPE J. 2000, 5, 363–370. [Google Scholar] [CrossRef]
  10. Noureldin, A.; Tabler, H.; Irvine-Halliday, D.; Mintchev, M.P. A new borehole surveying technique for horizontal drilling processes using one fiber optic gyroscope and three accelerometers. In Proceedings of the IADC/SPE Drilling Conference, New Orleans, LA, USA, 23–25 February 2000.
  11. Estes, R.A.; Epplin, D.M. Development of a robust gyroscopic orientation tool for MWD operations. In Proceedings of the SPE Annual Technical onference and Exhibition, Dallas, TX, USA, 1–4 October 2000.
  12. Li, T.; Yuan, G.; Lan, H.; Mintchev, M. Design and algorithm verification of a gyroscope-based inertial navigation system for small-diameter spaces in multilateral horizontal drilling applications. Micromachines 2015, 6, 1467–1970. [Google Scholar] [CrossRef]
  13. Britting, K.R. Inertial Navigation Systems; Wiley-Interscience: New York, NY, USA, 1971; p. 249. [Google Scholar]
  14. Noureldin, A.; Karamat, T.B.; Georgy, J. Fundamentals of Inertial Navigation, Satellite-Based Positioning and Their Integration; Springer: Berlin/Heidelberg, Germany, 2014; p. 314. [Google Scholar]
  15. Quinchia, A.G.; Falco, G.; Falletti, E.; Dovis, F.; Ferrer, C. A comparison between different error modeling of mems applied to GPS/INS integrated systems. Sensors 2013, 13, 9449–9588. [Google Scholar] [CrossRef] [PubMed]
  16. Barshan, B.; Durrant-Whyte, H.F. Inertial navigation systems for mobile robots. IEEE Trans. Robot. Autom. 1995, 11, 328–342. [Google Scholar] [CrossRef] [Green Version]
  17. Scherzinger, B. Inertial navigator error models for large heading uncertainty. In Proceedings of the IEEE Position Location and Navigation Symposium, Atlanta, GA, USA, 22–26 April 1996; pp. 477–484.
  18. Savage, P.G. Moving Base INS Alignment with Large Initial Heading Error; Strapdown Associates, Inc.: Maple Plain, MN, USA, 2014. [Google Scholar]
  19. Djurić, P.M.; Kotecha, J.H.; Zhang, J.; Huang, Y.; Ghirmai, T.; Bugallo, M.F.; Miguez, J. Particle filtering: A review of the theory and how it can be used for solving problems in wireless communications. IEEE Signal Process. Mag. 2003, 20, 19–38. [Google Scholar] [CrossRef]
  20. Noureldin, A. New measurement-while-drilling surveying technique utilizing sets of fiber optic rotation sensors. Ph.D. Thesis, University of Calgary, Calgary, AB, Canada, 2002. [Google Scholar]
  21. Shin, E.-H. Accuracy improvement of low cost INS/GPS for land applications. Master‘s Thesis, University of Calgary, Calgary, AB, Canada, 2001. [Google Scholar]
  22. Jurkov, A.S.; Cloutier, J.; Pecht, E.; Mintchev, M.P. Experimental feasibility of the in-drilling alignment method for inertial navigation in measurement-while-drilling. IEEE Trans. Instrum. Meas. 2011, 60, 1080–1090. [Google Scholar] [CrossRef]
  23. Mintchev, M.P.; Pecht, E.; Cloutier, J.; Dzhurkov, A. In-drilling alignment. U.S. Patent 7,823,661 B2, 2 November 2010. [Google Scholar]
  24. Zhenhua, W. MEMS-based downhole inertial navigation systems for directional drilling applications. Master‘s Thesis, University of Calgary, Calgary, AB, Canada, 2015. [Google Scholar]
  25. Zhenhua, W.; Poscente, M.; Filip, D.; Dimanchev, M.; Mintchev, M. Rotary in-drilling alignment using an autonomous MEMS-based inertial measurement unit for measurement-while-drilling processes. IEEE Instrum. Meas. Mag. 2013, 16, 26–34. [Google Scholar]
  26. Goshen-Meskin, D.; Bar-Itzhack, I.Y. Unified approach to inertial navigation system error modeling. J. Guid. Control Dyn. 1992, 15, 648–653. [Google Scholar] [CrossRef]
  27. Myeong-Jong, Y.; Heung-Won, P.; Chang-Bae, J.; Myeong-Jong, Y.; Heung-Won, P.; Chang-Bae, J. Equivalent nonlinear error models of strapdown inertial navigation system. In Proceedings of the Guidance, Navigation, and Control Conference, New Orleans, LA, USA, 11–13 August 1997.
  28. Friedland, B. Analysis strapdown navigation using quaternions. IEEE Trans. Aerosp. Electron. Syst. 1978, 14, 764–768. [Google Scholar] [CrossRef]
  29. Savage, P.G. Mitigating Second Order Error Effects in Linear Kalman Filters Using Adaptive Process and Measurement Noise; Strapdown Associates, Inc.: Maple Plain, MN, USA, 2014; pp. 17–26. [Google Scholar]
  30. Yeon Fuh, J.; Yu Ping, L. On the rotation vector differential equation. IEEE Trans. Aerosp. Electron. Syst. 1991, 27, 181–183. [Google Scholar] [CrossRef]
  31. Myeong-Jong, Y.; Jang Gyu, L.; Heung-Won, P. Comparison of SDINS in-flight alignment using equivalent error models. IEEE Trans. Aerosp. Electron. Syst. 1999, 35, 1046–1054. [Google Scholar] [CrossRef]
  32. Bortz, J.E. A new mathematical formulation for strapdown inertial navigation. IEEE Trans. Aerosp. Electron. Syst. 1971, AES-7, 61–66. [Google Scholar] [CrossRef]
  33. Shuster, M.D. The kinematic equation for the rotation vector. IEEE Trans. Aerosp. Electron. Syst. 1993, 29, 263–267. [Google Scholar] [CrossRef]
  34. Savage, P.G. Strapdown Analytics; Strapdown Associates, Inc.: Maple Plain, MN, USA, 2000. [Google Scholar]
  35. Farrell, J. Aided Navigation: GPS with High Rate Sensors, 1st ed.; McGraw-Hill Education: New York, NY, USA, 2008; pp. 32–33. [Google Scholar]
  36. Rogers, R.M. Applied Mathematics in Integrated Navigation Systems, 2nd ed.; American Institute of Aeronautics and Astronautics, Inc.: Reston, VA, USA, 2003; pp. 106–107. [Google Scholar]
  37. Benson, D.O. A comparison of two approaches to pure-inertial and doppler-inertial error analysis. IEEE Trans. Aerosp. Electron. Syst. 1975, AES-11, 447–455. [Google Scholar] [CrossRef]
  38. Schwarz, K.P.; Wei, M. A framework for modelling kinematic measurements in gravity field applications. Bull. Géod. 1990, 64, 331–346. [Google Scholar] [CrossRef]
  39. El-Sheimy, N. Inertial Techniques and INS/DGPS Integration (ENGO 623); Geomatics: Calgary, AB, Canada, 2006. [Google Scholar]
  40. Cappe, O.; Godsill, S.J.; Moulines, E. An overview of existing methods and recent advances in sequential monte carlo. IEEE Proc. 2007, 95, 899–924. [Google Scholar] [CrossRef]
  41. Doucet, A.; Godsill, S.; Andrieu, C. On sequential monte carlo sampling methods for Bayesian filtering. Stat. Comput. 2000, 10, 197–208. [Google Scholar] [CrossRef]
  42. Papoulis, A. Probability, Random Variables and Stochastic Processes; McGraw-Hill, Inc.: New York, NY, USA, 1991; pp. 637–638. [Google Scholar]
  43. Gordon, N.J.; Salmond, D.J.; Smith, A.F.M. Novel approach to nonlinear/non-gaussian bayesian state estimation. IEE Proc. F Radar Signal Process. 1993, 140, 107–113. [Google Scholar] [CrossRef]
  44. Li, T.; Corchado, J.M.; Bajo, J.; Sun, S.; Paz, J.F.D. Effectiveness of bayesian filters: An information fusion perspective. Inf. Sci. 2016, 329, 670–689. [Google Scholar] [CrossRef]
  45. Gustafsson, F.; Gunnarsson, F.; Bergman, N.; Forssell, U.; Jansson, J.; Karlsson, R.; Nordlund, P.J. Particle filters for positioning, navigation, and tracking. IEEE Trans. Signal Process. 2002, 50, 425–437. [Google Scholar] [CrossRef]
  46. Liu, J.S. Sequential monte carlo methods for dynamic systems. J. Am. Stat. Assoc. 1998, 93, 1032–1044. [Google Scholar] [CrossRef]
  47. Wang, X.; Wang, S.; Ma, J. An improved particle filter for target tracking in sensor systems. Sensors 2007, 7, 144–156. [Google Scholar] [CrossRef]
  48. Cheng, Y.; Crassidis, J.L. Particle filtering for attitude estimation using a minimal local-error representation. J. Guid. Control Dyn. 2010, 33, 1305–1310. [Google Scholar] [CrossRef]
  49. Storvik, G. Particle filters for state-space models with the presence of unknown static parameters. IEEE Trans. Signal Process. 2002, 50, 281–289. [Google Scholar] [CrossRef]
  50. Handschin, J.E.; Mayne, D.Q. Monte carlo techniques to estimate the conditional expectation in multi-stage non-linear filtering. Int. J. Contro 1969, 9, 547–559. [Google Scholar] [CrossRef]
  51. Handschin, J.E. Monte carlo techniques for prediction and filtering of non-linear stochastic processes. Automatica 1970, 6, 555–563. [Google Scholar] [CrossRef]
  52. Katja, N.; Koller-Meier, E.; Gool, L.V. An adaptive color-based particle filter. Image Vision Comput. 2003, 21, 99–110. [Google Scholar]
  53. Haug, A.J. Introduction to Monte Carlo Methods; Springer: New York, NY, USA, 2009; pp. 1–49. [Google Scholar]
  54. Gustafsson, F. Particle filter theory and practice with positioning applications. IEEE Aerosp. Electron. Syst. Mag. 2010, 25, 53–82. [Google Scholar] [CrossRef]
  55. Fox, D.; Thrun, S.; Burgard, W.; Dellaert, F. Particle Filters for Mobile Robot Localization; Springer: New York, NY, USA, 2001; pp. 401–428. [Google Scholar]
  56. Simon, D. Optimal State Estimation: Kalman, H Infinity, and Nonlinear Approaches, 1st ed.; John Wiley & Sons, Inc.: Hoboken, NJ, USA, 2006; pp. 400–403. [Google Scholar]
  57. Li, T.; Bolic, M.; Djuric, P.M. Resampling methods for particle filtering: Classification, implementation, and strategies. IEEE Signal Process. Mag. 2015, 32, 70–86. [Google Scholar] [CrossRef]
  58. Bay, K.S.; Lee, S.J.; Flathman, D.P.; Roll, J.W.; Piercy, W. Sequential imputations and Bayesian missing data problems. J. Am. Stat. Assoc. 1994, 89, 278–288. [Google Scholar]
  59. Kitagawa, G. Monte carlo and smoother for non-Gaussian nonlinear state space models. J. Comput. Gr. Stat. 1996, 5, 1–25. [Google Scholar]
  60. Sileshi, B.G.; Ferrer, C.; Oliver, J. Particle filters and resampling techniques: Importance in computational complexity analysis. In Proceedings of the 2013 Conference on Design and Architectures for Signal and Image Processing (DASIP), Cagliari, Italy, 8–10 October 2013; pp. 319–325.
  61. Beadle, E.R.; Djuric, P.M. A fast-weighted bayesian bootstrap filter for nonlinear model state estimation. IEEE Trans. Aerosp. Electron. Syst. 1997, 33, 338–343. [Google Scholar] [CrossRef]
Figure 1. Recursive Bayesian estimation model. The first horizontal row represents the states of the system, which propagate in terms of Equation (31), and the column represents the measurement process, which is formulated by Equation (32). x 0 ,   x 1 ,   x k 2 ,   x k 1 ,   x k are the system states from time 0 to time k and z 1 ,   z k 2 ,   z k 1 ,   z k are the measurements from time 1 to time k.
Figure 1. Recursive Bayesian estimation model. The first horizontal row represents the states of the system, which propagate in terms of Equation (31), and the column represents the measurement process, which is formulated by Equation (32). x 0 ,   x 1 ,   x k 2 ,   x k 1 ,   x k are the system states from time 0 to time k and z 1 ,   z k 2 ,   z k 1 ,   z k are the measurements from time 1 to time k.
Sensors 16 00371 g001
Figure 2. Principle of resampling.
Figure 2. Principle of resampling.
Sensors 16 00371 g002
Figure 3. Configuration of the MGWD device. Each MEMS sensor is composed of a single-axis gyroscope and three-axis accelerometers. The body frame is the right (X-axis), forward (Y-axis) and up (Z-axis) direction.
Figure 3. Configuration of the MGWD device. Each MEMS sensor is composed of a single-axis gyroscope and three-axis accelerometers. The body frame is the right (X-axis), forward (Y-axis) and up (Z-axis) direction.
Sensors 16 00371 g003
Figure 4. Process of data collection and contents of experiments. The MEMS sensors sense the angular rate and specific force of the drill bit and then transfer the data to the computer through a USB interface for evaluation of navigation solutions. The proposed algorithm would be verified by two groups of designed experiments with the reference of zero velocity and zero position. The design rule of experiments is based on the initial attitude error.
Figure 4. Process of data collection and contents of experiments. The MEMS sensors sense the angular rate and specific force of the drill bit and then transfer the data to the computer through a USB interface for evaluation of navigation solutions. The proposed algorithm would be verified by two groups of designed experiments with the reference of zero velocity and zero position. The design rule of experiments is based on the initial attitude error.
Sensors 16 00371 g004
Figure 5. Original data obtained from experiments using the MGWD device. (a) Original data from two-axis gyroscopes; (b) original data from three-axis accelerometers. The length of experimental data is 600 s in quasi-stationary conditions.
Figure 5. Original data obtained from experiments using the MGWD device. (a) Original data from two-axis gyroscopes; (b) original data from three-axis accelerometers. The length of experimental data is 600 s in quasi-stationary conditions.
Sensors 16 00371 g005
Figure 6. Initial particles p ( x 0 | z 0 ) and initial weights w 0 i for the PF. The initial particles and weights of attitude errors ( δ ϕ , δ θ , δ ψ ) , velocity errors ( δ V N ,   δ V E ,   δ V D ) , and position errors ( δ φ ,   δ λ ,   δ h ) are identical because the initial parameters (initial states and initial estimation errors) to evaluate the initial particles and initial weights are the same.
Figure 6. Initial particles p ( x 0 | z 0 ) and initial weights w 0 i for the PF. The initial particles and weights of attitude errors ( δ ϕ , δ θ , δ ψ ) , velocity errors ( δ V N ,   δ V E ,   δ V D ) , and position errors ( δ φ ,   δ λ ,   δ h ) are identical because the initial parameters (initial states and initial estimation errors) to evaluate the initial particles and initial weights are the same.
Sensors 16 00371 g006
Figure 7. Particles or samples, along with the corresponding weights for evaluation of the posterior function. (a1) and (a2) are particles of velocity errors and the corresponding weights; (b1) and (b2) are the particles of attitude errors and the corresponding weights; (c1) and (c2) are the particles of positon errors and the corresponding weights. The priori pdf is the importance density function. The designator   δ L , the same as δ φ , is the latitude error.
Figure 7. Particles or samples, along with the corresponding weights for evaluation of the posterior function. (a1) and (a2) are particles of velocity errors and the corresponding weights; (b1) and (b2) are the particles of attitude errors and the corresponding weights; (c1) and (c2) are the particles of positon errors and the corresponding weights. The priori pdf is the importance density function. The designator   δ L , the same as δ φ , is the latitude error.
Sensors 16 00371 g007
Figure 8. Evaluation of state density.
Figure 8. Evaluation of state density.
Sensors 16 00371 g008
Figure 9. Comparison of the performance of KF with LEM and PF with NEM or NNEM under small-angle attitude errors conditions. (a1) and (a2) are the estimated attitude and the corresponding estimation error; (b1) and (b2) are the estimated velocity and the corresponding estimation error; (c1) and (c2) are the estimated position and the corresponding estimation error. Plotting the figure uses the double Y-axis plotting approach because the results are in different orders of magnitude.
Figure 9. Comparison of the performance of KF with LEM and PF with NEM or NNEM under small-angle attitude errors conditions. (a1) and (a2) are the estimated attitude and the corresponding estimation error; (b1) and (b2) are the estimated velocity and the corresponding estimation error; (c1) and (c2) are the estimated position and the corresponding estimation error. Plotting the figure uses the double Y-axis plotting approach because the results are in different orders of magnitude.
Sensors 16 00371 g009aSensors 16 00371 g009b
Figure 10. Results of attitude and estimation error of attitude by KF with LEM, PF with NEM, and PF with NNEM under large-angle attitude error conditions. (a1) and (a2) are the estimation of roll and estimation error of roll; (b1) and (b2) are the estimation of pitch and estimation error of pitch; (c1) and (c2) are the estimation of azimuth and estimation error of azimuth. Plotting the figure uses the triple Y-axis plotting approach because the results are in different orders of magnitude.
Figure 10. Results of attitude and estimation error of attitude by KF with LEM, PF with NEM, and PF with NNEM under large-angle attitude error conditions. (a1) and (a2) are the estimation of roll and estimation error of roll; (b1) and (b2) are the estimation of pitch and estimation error of pitch; (c1) and (c2) are the estimation of azimuth and estimation error of azimuth. Plotting the figure uses the triple Y-axis plotting approach because the results are in different orders of magnitude.
Sensors 16 00371 g010
Figure 11. Results of estimation of velocity and estimation error of velocity by KF with LEM, PF with NEM, and PF with NNEM under large-angle attitude error conditions. (a1) and (a2) are the estimation of north velocity and estimation error of north velocity; (b1) and (b2) are the estimation of east velocity and estimation error of east velocity; (c1) and (c2) are the estimation of down velocity and estimation error of down velocity.
Figure 11. Results of estimation of velocity and estimation error of velocity by KF with LEM, PF with NEM, and PF with NNEM under large-angle attitude error conditions. (a1) and (a2) are the estimation of north velocity and estimation error of north velocity; (b1) and (b2) are the estimation of east velocity and estimation error of east velocity; (c1) and (c2) are the estimation of down velocity and estimation error of down velocity.
Sensors 16 00371 g011
Figure 12. Results of estimation of position and estimation error of position by KF with LEM, PF with NEM, and PF with NNEM under large-angle attitude error condition. (a1) and (a2) are the estimation of latitude and estimation error of latitude; (b1) and (b2) are the estimation of longitude and estimation error of longitude; (c1) and (c2) are the estimation of height and estimation error of height.
Figure 12. Results of estimation of position and estimation error of position by KF with LEM, PF with NEM, and PF with NNEM under large-angle attitude error condition. (a1) and (a2) are the estimation of latitude and estimation error of latitude; (b1) and (b2) are the estimation of longitude and estimation error of longitude; (c1) and (c2) are the estimation of height and estimation error of height.
Sensors 16 00371 g012aSensors 16 00371 g012b
Table 1. Technical specifications for SCC1300-D04.
Table 1. Technical specifications for SCC1300-D04.
ParametersGyroscopeParametersAccelerometer
Offset Short Term Instability<2.1 °/hOffset Error±70 mg
Angular Random Walk0.86 °/ h Linearity Error±40 mg
Noise Density0.02 (°/s/ h ) Noise5 ~ 7 mg
Temperature−40 ~ +125 °CTemperature−40 ~ +125 °C
Table 2. Technical specifications for CC2538.
Table 2. Technical specifications for CC2538.
ParametersValuesParametersValues
ProcessorARM Cortex-M3DebuggingcJTAG and JTAG
Frequency24 MHzRF2.4 GHz IEEE 802.15.4 Transceiver
PeripheralsUSB/I2C/SSI/UARTSize8 mm × 8 mm
Temperature−40 ~ +125 °CVoltage2 V ~ 3.6 V
Table 3. Navigation solutions and corresponding errors estimated by PF with NNEM, PF with NEM, and KF with LEM in Experiment 2.
Table 3. Navigation solutions and corresponding errors estimated by PF with NNEM, PF with NEM, and KF with LEM in Experiment 2.
ParametersPF   +   NNEMPF   +   NEMKF + LEM
φ 45.777664 ° 45.777613 ° 45.777935 °
λ 126.687953 ° 126.687934 ° 126.688326 °
h 123.999686 m123.652484 m120.945752 vm
V N 0.002984 m/s0.0197424 m/s0.983472 m/s
V E −0.000019 m/s−0.234530 m/s1.342358 m/s
V D 0.005637 m/s0.287584 m/s1.846332 m/s
ϕ −0.021976 ° −0.034748 ° −0.053672 °
θ 0.184392 ° −0.068584 ° −0.026478 °
ψ −9.893302 ° −2.527547 ° −2.599384 °
δ φ −0.362394 × 10−7−0.000014 ° −0.000238 °
δ λ −0.457395 × 10−8−0.000106° −0.000056 °
δ h −0.000348 m−0.196528 m−8.872501 m
δ V N 0.075922 m/s0.128473 m/s0.248382 m/s
δ V E 0.048975 m/s0.056483 m/s0.287349 m/s
δ V D −0.00648 m/s−0.039320 m/s0.877265 m/s
δ ϕ −0.000464 ° 0.003502 ° 0.004882 °
δ ψ 0.000353 ° 0.004528 ° 0.005216 °
δ ψ −0.000025 ° 2.459532 ° 1.879347 °

Share and Cite

MDPI and ACS Style

Li, T.; Yuan, G.; Li, W. Particle Filter with Novel Nonlinear Error Model for Miniature Gyroscope-Based Measurement While Drilling Navigation. Sensors 2016, 16, 371. https://doi.org/10.3390/s16030371

AMA Style

Li T, Yuan G, Li W. Particle Filter with Novel Nonlinear Error Model for Miniature Gyroscope-Based Measurement While Drilling Navigation. Sensors. 2016; 16(3):371. https://doi.org/10.3390/s16030371

Chicago/Turabian Style

Li, Tao, Gannan Yuan, and Wang Li. 2016. "Particle Filter with Novel Nonlinear Error Model for Miniature Gyroscope-Based Measurement While Drilling Navigation" Sensors 16, no. 3: 371. https://doi.org/10.3390/s16030371

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop