SciELO - Scientific Electronic Library Online

 
vol.18 número4Optimal hybrid inventory replenishment runtime for a vendor- buyer coordinated system with breakdowns and rework/disposal of nonconforming items índice de autoresíndice de materiabúsqueda de artículos
Home Pagelista alfabética de revistas  

Servicios Personalizados

Revista

Articulo

Indicadores

Links relacionados

  • No hay artículos similaresSimilares en SciELO

Compartir


Journal of applied research and technology

versión On-line ISSN 2448-6736versión impresa ISSN 1665-6423

J. appl. res. technol vol.18 no.4 Ciudad de México ago. 2020  Epub 31-Jul-2021

https://doi.org/10.22201/icat.24486736e.2020.18.4.1196 

Artículos

Real time localization solution for land vehicle application using low-cost integrated sensors with GPS

Abdalla Eldesokya  * 

Ahmed M. Kamelb 

M. Elhabibyc 

Hadia Elhennawya 

aDept. of Comm. Ain Shams University, Cairo, Egypt

bDept. of R&D. Military Technical College, Cairo, Egypt

cDept. of Public Works, Ain Shams University, Cairo, Egypt


Abstract:

The technique proposed in this research demonstrates a real time nonlinear data fusion solution based on extremely low-cost and grade inertial sensors for land vehicle navigation. Here, the utilized nonlinear multi-sensor data fusion (MSDF) is based on the combination between extremely low-cost micro electrical mechanical systems (MEMS) inertial, heading, pressure, and speed sensors in addition to satellite-based navigation system. The integrated navigation system fuses position and velocity states from the Global Positioning System (GPS), the velocity measurements from an odometer, heading angle observation from a magnetometer and navigation states from an inertial navigation system (INS). The implemented system performance is assessed through the post-processing of collected raw measurements and real time experimental work. The system that runs the real-time experiments is established on three connected platforms, two of them are based on a 32-bit ARMTM core and the third one is based 16-bit AVR ATMEL microcontroller. This microcontroller is connected to an on-board diagnostics (OBD) shield to collect the vehicle speed measurements. The raw data obtained from the integrated sensors is saved and post processed in MATLAB®. In normal conditions, the estimated position errors are reduced through the usage of INS/GPS integration with heading observation angle from a magnetometer. In GPS-denied environments, the integrated system uses the observations from INS, magnetometer in addition to the velocity from odometer to ensure a continuous and accurate navigation solution. A complementary filter (CF) is implemented to estimate and improve the pitch and roll angles calculations. In addition to that, an unscented Kalman filter (UKF) is used cascaded with the designed CF to complete the designed sensors fusion algorithm. Experimental results show that the designed MSDF can achieve a good level of accuracy and a continuous localization solution of a land vehicle in different GPS availability cases and can be implemented on the available in the market processors to be run in real time.

Keywords: MEMS; Multi-sensor data fusion; land vehicle; GPS; complementary filter; UKF

1. Introduction

Nowadays, navigation systems are involved in many applications in different life-fields. This leads researchers to investigate the development of navigational techniques to reduce the navigation estimation errors and achieve the best results with lowest prices. Therefore, the development of navigation systems using MEMS inertial sensors is taken into account with the navigation system industry. MEMS inertial measuring units (IMUs) are characterized by low-cost and light weight. Development of MEMS based INS is usually difficult due to its high error rate and high deviation of the readings over time (EIdesoky, Kamel, Elhabiby, & Elhennawy 2017a; Hazry & Zul, 2009; Maklouf, Ghila, Abdulla, & Yousef, 2013). GPS receivers provide more accurate and continuous positioning, but with a lower measurements rate. Furthermore, satellite signals are not always available in different conditions such as urban canyons, tunnels, and even indoor situations such as parking garages. Although GPS/INS integration has proven to be a reliable solution (Aftatah, Lahrech, Abounada, & Soulhi, 2016; Shin, 2005) still there are problems when GPS signals are not available. Generally, to overcome this problem, data collected from different additional navigational sensors are acquired, fused and processed to increase the navigation accuracy and we refer to this kind of fusion by MSDF. Currently, the trend is how to overcome the dependence on the GPS by increasing the number of sensors used in navigation; therefore recently, all sources positioning navigation (ASPN) is a very important branch for many researchers in the field of navigation to achieve low-cost, robust, accurate and effective navigation solutions, whatever the availability of GPS (Penn, 2012).In addition, the design of integrated system using a good estimator is an important as same as the significance of increasing the number of navigation sensors to have more reliable, accurate and robust navigation system. All the inertial sensors, microcontroller boards and processor boards which are used in our land vehicle navigation application have been chosen based on the cheapest hardware in the market with an extremely low-performance to be as a challenge to verify the proposed algorithm, a continuous localization solution with a very good level of accuracy performance has been achieved based on our proposed algorithm. A lot of researchers did outstanding efforts toward the objective of this work. To name a few, Xu et al. proposed a reliable hybrid positioning methodology for ground vehicles based on MEMS sensors and approximately costs 4500 ($) (Xu, Li, Li, Song, & Cai, 2016). Zhang et al. proposed a 500$ forward velocity model that depends on the non-holonomic constraints and has been tested by STIM300 IMU from Sensonor (Zhang & Niu, 2018). Nevertheless, other researchers have started to pay attention to another low-cost and grade inertial sensor such as the work proposed by Ahmed and Tahir (2017), via utilizing the measurements from L3GD20 IMU by ST Microelectronics which approximately cost 10 ($) to evaluate a vehicle attitude estimation. The proposed system presented in this work is based on the extremely low-cost and grade inertial sensors MPU-6050 IMU from InvenSenseTM. The achieved real time land vehicle localization solution approximately costs 7 ($) per unit. This IMU and its series can be easily found in various electronic stores or in e-marketing applications. What's more, it is widely used in the field of control systems for robots or small unmanned systems due to light weight, low-cost and low-power consumption. In this work, the additional sensors which we used are the odometer and the magnetic compass. The proposed loosely coupled integrated GPS/INS/odometer/magnetometer system provides an increasing of the accuracy and robustness of the navigation solution and enhanced the positioning estimation unlike using a separate GPS or standalone INS system. The common solution algorithm for GPS/INS integration is the Extended Kalman Filter (EKF). However, EKF depends on the basic assumptions linearization of the nonlinear system and Gaussian noise distribution (El-Sheimy & Youssef, 2020), and the INS 1st order linearized error model is usually used. Although this assumption has proved to have a very good performance, it still associated with low-cost MEMS sensors but in the case of weak GPS signals, noisy environment or outage signals, the performance is degraded. Unlike the EKF, the unscented Kalman filter (UKF) doesn’t require a linearized model and directly it can be applied to the nonlinear model and it is easier to implement because it doesn’t need analytic derivation or Jacobians as the EKF (Julier & Uhlmann, 1997; Van der Merwe, Wan, & Julier, 2004), The usage of UKF for navigation sensors data fusion is discussed in detail in the context of this paper. For further improvement of attitude angles, the complementary filter (CF) has been used to fuse the estimated angles from both the gyroscopes and accelerometers that construct the IMU. CF applies a low-pass filter to accelerometer measurements and a high pass filter to the integrated gyroscopes measurements to improve the attitude estimation. The objective of this work is to evaluate and validate the performance of the position estimation, by implementing a low-cost integrated navigation system based on a selected extremely low-cost and grade MPU-6050, that consists of three-axis accelerometers, three-axis gyroscopes and three-axis digital compass. Three microcontroller boards are interfaced together, two platforms of 32-bit ARM core microcontroller boards with 512 KB memory (one of them is used to perform navigation arithmetic calculations of the inertial sensors and the other is used to process a low-cost commercial GPS receiver). The third platform is a 16-bit AVR ATMEL microcontroller board which connected through CAN BUS with OBD shield to acquire the ground speed measurements. Signal acquisition, mechanization modeling, CF and UKF processes are performed via three boards for real-time calculations. IMU, odometer and GPS raw measurements data are also logged for further post processing under MATLAB for system tuning and offline integration evaluation which helps in the enhancement of the system performance.

In the next sections, the sensors models are presented in section (2), section (3) describes the CF and UKF filters theories, section (4) presents a loosely coupled GPS/INS/Odometer/Magnetometer system implementation by utilizing UKF, section (5) shows the evaluation of the experimental work and results. Finally, the conclusion is presented in section (6).

2. Sensors Modeling

2.1. INS sensor model

The INS mechanization equations are used to obtain the navigation solutions position, velocity, and attitude (PVA) of the vehicle in the East-North-Up (ENU) navigation frame (n-frame), which is known as local-level frame (LLF). These solutions are derived from the angular rates measurements acquired from the three gyroscopes and specific forces measured from three accelerometers as shown in Figure 1. (Aggarwal, El-Sheimy, & Noureldin, 2010).

Figure 1 INS model diagram in the local level frame. 

The acceleration is measured by the accelerometers in the body frame, and then transformed to the navigation frame for getting useful information. This operation is done using the transformation matrix through the attitude angles that are obtained from integrating the gyro rates. The projected acceleration is purified from Coriolis motion and the external effects of gravity by getting pure implication of the body motion. The output is integrated to obtain position and velocity as described in (Noureldin, Karamat, & Georgy, 2012).

2.2. Odometer sensor model

The odometer is a self-independent sensor which measures the land vehicle travelled distance over time, and it is used for continuously estimating the ground vehicle speed without any external interference to improve the navigation performance; especially during GPS outages. With the assumptions of the non-holonomic constraints which is the vehicle does not jump-off or slides on the ground, the vehicle velocity in the plane perpendicular to the forward direction is almost zero (Sukkarieh,1999). These constraints can be considered as a zero velocity update (ZUPT) along two axes of the vehicle (up and right).

Vbz0, Vbx0, and Vby "Velocity from odometer,

where Vbz,Vbx, and

Vby are the velocity projections in the b frame

(Vb) along up,right and forward directions respectively."

2.3. Magnetometer sensor model

Magnetometer measures the earth's magnetic fields in its three axes X, Y and Z, so the heading can be determined in the horizontal planes, X and Y. The magnetometer measurements must be compensated for the effects of nearby ferrous materials by calculating the bias and offset in a process called hard-iron and soft-iron compensation. Once the measurements are corrected, the declination angle is applied to adjust magnetic north to true north.

A simple calibration method can be used to determine the offset and scale factor values, by mounting the compass in the car and taking a circular path on a horizontal surface, then getting the maximum and minimum values of the X and Y magnetic readings as follow:

Xsf=Ymax-Ymin/Xmax-Xmin (1)

Xsf=1 or Xmax-Xmin/Ymax-Ymin (2)

Xoff= (Xmax-Xmin/2)-Xmax*Xsf (3)

Xoff= (Ymax-Ymin/2)-Ymax*Xsf (4)

Xc=Xm-Xoff*Xsf (5)

Yc=Ym-Yoff*Ysf (6)

where, Xsf,Ysf,Xoff,Yoff,Xm,Ym,Xc,Yc are the scale factor, offset, measured and calibrated of the X and Y axes, respectively.

Heading= arctan Yc / Yc (7)

Heading=Heading + declination angle

The used declination angle = 4.0 + 28.0 / 60.0 / 180 /π

3. Complementary and Unscented Filters

3.1. Complementary Filter

For more precise orientation estimation, accelerometers and gyroscopes are used together. The gyroscope data is useful in a short-time term because the integrated angle from the gyroscope drifts over time; while, the accelerometer data is useful in the long-time term because the accelerometer has a slow response calculation time for calculated tilt angles. The complementary filter is designed in such a way that the strength of one sensor will be used to overcome the weaknesses of the other sensor which makes each complementary to the other. The algorithm is given by:

Estimated Angle=((α)×(Previous Angle+(Gyroreading×dt))Integration                                                High-pass filter +((1-α)×(tiltangle by accelerometer)))Low-pass filter (8)

α=τ/(τ+dt)

where:

α is the filter coefficient, τ is the time constant ,

dt is the sample period

The tilt angle by accelerometer is calculated by measuring the gravity component in the horizontal accelerometers, then the estimated pitch and roll angles can be calculated. The CF combines the high-pass filter estimations from integrated gyro measurements with the current angle value and low-pass filter estimations from accelerometers measurements as shown in Figure 2. The CF algorithm is applicable in the conditions of low-body accelerations or nearly constant vehicle velocity which is the case of the designed experiments. For higher acceleration conditions such as racing cars or maneuvering missiles, this algorithm is no longer valid due to high dynamic motions.

Figure 2 Basic complementary filter. 

3.2. Filter coefficient calculation

The time constant τ gives the boundary of trusting the gyroscopes and accelerometers, in this work dt=0.025sec and τ=0.225sec. For τ shorter than 0.225 sec, then the priority will be the integrated gyroscope readings and the noisy horizontal accelerations will be filtered; while if τ is more than 0.225 sec, then the accelerometer average is given more weighting than gyroscope. So, the calculated filter coefficient will be α=0.9.

3.3. Unscented Kalman Filter

The system state distribution and its relevant noise densities with respect to EKF are approximated by the Gaussian random variable (GRV), which are propagated analytically through a first-order linearization of the nonlinear system. Hence, the methodology of EKF can be introducing large linearization errors in the true posterior mean and covariance of the GRV transformation, which may lead to suboptimal performance. The UKF can be overcome the linearization errors problem by using a deterministic sampling approach. By using this approach, the system state distribution can be approximated by a GRV which represented by using a minimal set of carefully chosen weighted sample points. These sample points completely capture the true mean and covariance of the GRV, and then propagate through the true nonlinear system, then capturing the posterior mean and covariance accurately to the 2nd order Taylor series expansion for any nonlinearity.

3.4. Unscented Transformation

The unscented transformation (UT) is a technique for determining the statistics of random variable that has a nonlinear transformation. Consider propagation a random variable x (dimension L) through a nonlinear function y=f(x). Assumex has mean x̄ and covariance Px. To calculate the statistics of y, we form a matrix χ of 2L+1 sigma vectors χi according to the following

χ0=x̄,χi=x̄+((L+λ)Px)i,       i=1,...,L, χi=x̄-((L+λ)Px)i-L,   i=L+1,...,2L. (9)

Where, λ=α2(L+k)-L is a parameter of scaling. α determines the spread of the sigma points around x̄, and is small positive value (e.g., 10-4α1). The constant k is a secondary scaling parameter, which is usually set to 3-L, and ((L+λ)Px)i is the ith column of the matrix square root (e.g., lower-triangular Cholesky factorization). These sigma vectors are propagated through the nonlinear function;

Yi=f(χi),      i=0,...,2L (10)

The mean and covariance for y are approximated using a weighted sample mean and covariance of the posterior sigma points,

y¯i=02LWi(m)Yi (11)

Pyi=02LWi(C)Yi-y¯Yi-y¯T (12)

with weights Wi given by

W0(m)=λL+λ,W0(C)=λL+λ+1-α2+β.  Wi(m)=Wi(C)=λ2(L+λ),i=1,,2L. (13)

where β is used to incorporate prior knowledge of the distribution of x (for Gaussian distributions, β=2 is optimal) (Julier, Uhlmann, & Durrant-Whyte, 1995)

Figure 3 gives an example for a two-dimensional system, Figure 3a shows the Monte Carlo sampling true mean and covariance propagation, Figure 3b represents the output by linearization approach as the EKF and Figure 3c shows the performance of the UT for five sigma points.

Figure 3 Example of the UT for mean and covariance propagation: (a) actual; (b) first- order linearization (EKF); (c) UT. (Wan, Van Der Merwe, & Haykin, 2001). 

3.5. Unscented Kalman filter Implementation

The UKF can be implemented using UT method by expanding the state space to include the noise component x^ka=[x^kT vkT  nkT]T. The UKF can be summarized as follows (Wan & Van Der Merwe, 2000):

Initialization parameters:

x^0=E[x0],  Px0=E[(x0-x^0)(x0-x^0)T]   (14)

x^0a=E[x0a]=[x^0T 00]T (15)

P0a=E[(x0a-x^0a)(x0a-x^0a)T]    =P0000Rv000Rn (16)

where Rv is the process-noise covariance, Rn is the measurement-noise covariance Fork=1,...,

1. t = k-1

2. Sigma Points

   χta=[x^ta   x^ta+γPta x^ta-γPta] (17)

Where γ=L+λ

3. The time update equations are:

Propagation of the sigma points through the system equation

χktx=f(χtx,χtv,ut) (18)

x^k-=i=02LWim χi,ktx (19)

Pxk-=i=02LWic(χi,ktx-x^k-)(χi,ktx-x^k-)T+Rv (20)

The augmented sigma points is

χi,kt=[x^k-      x^k-+γPxk-x^k--γPxk-] (21)

4. Filtering

Yi,kt=h(χi,kt)   (22)

y^k-=i=02LWim Yi,kt (23)

Py~k=i=02LWic(Yi,kt-y~k-)(Yi,kt-y~k-)T+Rn   (24)

Pxk,yk=i=02LWic(χi,kt-x^k-)(Yi,kt-y~k-)T (25)

     Kk=Pxk,yk Py~k-1 (26)

x^k=x^k-+Kk(yk-y^k-) (27)

Pxk=Pxk- -Kt Py~k KkT (28)

Where yk observation matrix and h The observation model Figure 4 describes the UKF steps. At the first step; sigma points are generated from initial mean and covariance, then at the second step; the sigma points are propagated through the dynamic system, at third step; the mean and covariance of the transformed sigma points are captured, then at the fourth step; the augmented sigma points from the captured mean and covariance are calculated. Finally, the measurement update can be done to calculate the Kalman gain, state and covariance measurement updated matrices.

Figure 4 Operation steps of the unscented Kalman filter. 

3.6. Observation

After the observation information collected from the aiding inertial sensors, the observation vector can be generated as follow. In case of GPS is available then the position and velocity observation will be obtained from GPS receiver while, the heading observation angle will be obtained from magnetometer and the measurement vector will be as follow

yk=GPSPos(k)GPSVel(k)Heading(k) (29)

The observation model is

hk=I3x303x303x303x3I3x303x303x303x3M3x3 (30)

where M 3x3=000000001

The observation noise covariance matrix is

Rk=Pos3x3(k)03x303x303x3Vel3x3(k)03x303x303x3Rm3x3(k) (31)

where Rm 3x3=00000000Rm(k)

where Rm(k) magnetometer observation noise covariance On the other side in case of GPS signals are not available then the heading observation angle will be obtained from magnetometer while, the velocity observation information will be obtained from odometer in the body frame using the transformation matrix Rbl to get the velocity in (n-frame),

VOdo=Rbl0    V   by       0T (32)

The observation vector will be

yk=OdoV  el(k)Heading (k) (33)

The observation model is

hOdo(k)=03×3I3×303×303×303×3M3×3 (34)

The odometer observation noise covariance matrix for x, y and z axes in b-frame is

ROdo(k)=Rbx(k)000Rby(k)000Rbz(k) (35)

While the odometer velocity is transformed from the body frame to the navigation frame; as well its related observation noise covariance matrix has to be transformed, this transformation is done by

ROdo´k=Rbl(k)ROdo(k)Rbl(k)T (36)

The observation noise covariance matrix is

R(k)=03×3ROdo´k03×303×303×3Rm3×3(k) (37)

3.7. Loosely coupled GPS/INS integration

In this integration type, the GPS and INS operate independently and each one provides separate navigation information but the GPS signal information used to aid the INS mechanization to reduce the INS errors which increase rapidly with time and this aiding can be done by GPS measurement update via the step of integration filtering. Furthermore, the navigation solution performance will be improved after the estimated error states feeding to the INS mechanization. Frequently, this integration is based on Kalman filtering as shown in Figure 5, here we have implemented the proposed integration technique based on the unscented Kalman filter (Hieu & Nguyen, 2012).

Figure 5 Conventional loosely coupled GPS /INS. 

4. Integrated System Implementation

Regardless the availability of GPS status, the output from INS, magnetometer and CF have been used. To improve the estimated solution of pitch and roll angles, the CF algorithm has been implemented and its output has been fed to UKF. Hence, the heading observation angle has been received from magnetometer and fed to UKF as well for state estimation correction. Then if the GPS solution is available, the position and velocity from GPS receiver are fed to the UKF as an observation measurement to correct the state estimation which is fed back to the INS model. In addition, if the GPS solution is not available, then the velocity received from the odometer is fed to UKF as an observation measurement for state estimation correction. As shown in Figure 6.

Figure 6 Integrated system implementation diagram. 

4.1. Hardware Description

The hardware which we have used consists of three platforms. The first two platforms are 32-bit ARM core microcontroller boards. One of them is a master board which collects the raw data and controls it directly from the IMU with type MPU6050 and from the digital compass with type HMC5883L, receives the data from GPS and odometer via the communications with the other two boards through the interrupted serial port, executes the calculation of the heading angle based on the digital compass output, performs the INS modeling, and computes all the UKF integration algorithm calculations in both cases of GPS signal is available or not available regarding the correction of the navigation states estimation . The second board collects the data from the GPS receiver module with type SKM53 and sends it through a serial port to the master board with an interrupt every 1 second for measurement updating. The third platform is 16-bit AVR ATMEL microcontroller board with CANBUS OBD shield which collects the velocity measurements of the land vehicle and sends it via the serial port to the master board with an interrupt every 1 second for measurement updating. In our experimental work we have found that our proposed MSDF technique achieved a real time localization solution by enhancing the estimation of all the concerning navigation states and improving the accuracy performance based on utilizing the low-cost platforms hardware which mentioned above in the same section. All raw data collected from all the inertial low-cost sensors during the real time phase have been used as well in the post-processing phase for processing, analysis and verifying the validation of the proposed technique. We used the satellite data which we collected during the real-time phase as reference data for comparison against the real-time estimated navigation state. Figure 7 represents an illustration of the hardware configuration which have used in this work.

Figure 7 Hardware configuration. 

4.2. Test environment

A land vehicle-navigation test environment is shown in Figure 8 which shows that the reference trajectory of the experiment relative to GPS data in a red color. The measurements raw data from IMU were collected with a frequency rate 40Hz. Hence, the measurements data from GPS receiver and CANBUS were collected with a frequency rate 1Hz. Number of visible satellites in case of GPS signal is available were about 7~10 visible satellites. Average car velocity in land vehicle-navigation test environment was 45 km/h. The total navigation time was 304 seconds. The first period for 50 seconds was a stopping period for initial alignment, then after that the car started the travelling period for 254 seconds.

Figure 8 Reference trajectory relative to GPS data. 

5. Experimental Work and Results

5.1. Navigation results during GPS 1 sec update rate

In the beginning, with respect to the real-time solution (RTS), we made a conventional INS/GPS integration-based UKF without any kind of aiding sensors and without any correction for the pitch and roll channels by the CF and we refer to this case by (RTS without aiding), then after that we applied the complementary filter regard the correction of pitch and roll channels; in addition, we used the magnetometer as an aid sensor for more accurate heading angle and we refer to this case by (RTS with attitude aiding). In case of RTS with attitude aiding, we found that the performance of the integrated system has been improved by make a comparison between the quantitative position errors for both cases such as standard deviation, mean, maximum error in east and north positions and the maximum horizontal error (MHE), these quantitative position errors were found decreased due to the enhancement which occurred in the attitude channels as shown in Table 1 and in Figure 9 which they represent the real time solution with and without attitude aiding. As an example, we noticed that the MHE is reduced by 45.354 % in case of RTS with attitude aiding. Furthermore, we noticed that the RTS of the attitude errors in pitch, Roll and Heading directions are depicted as shown in Figure 10. Figure 11 clarifies the enhancement of the navigation resultant trajectory in Latitude/Longitude because of the reduction in errors after using the improved attitudes in case of RTS with attitude aiding. All the results shown in figures prove that the proposed technique is promising and the estimated trajectory based on RTS with attitude aiding follow the reference trajectory without significant errors. It is an important to be mentioned here that the accuracy of UKF slightly more accurate than the EKF due to the low-dynamics of the land vehicle (EIdesoky et al., 2017b; LaViola, 2003). From Table 1 we can notice that the utilized extremely low-cost and grade of IMU as an inertial sensor is suitable for low-cost integrated navigation systems of land vehicle applications which tolerate a 2D position with a maximum horizontal error (MHE) of about 3.19 meters in case of GPS available.

Table 1 Position errors during navigation in case of 1sec. GPS update rate. 

Position errors (m) for 1sec. GPS update rate
Mean Std. Max. Error Max. Horizontal Error
RTS without aiding East 0.384 0.51 3.964 5.840
North 0.688 0.76 4.289
RTS with attitude aiding East 0.227 0.24 1.899 3.1915
North 0.460 0.41 2.565

Figure 9 Position errors in east/north for GPS/INS integrated system in case of 1sec. GPS update rate. 

Figure 10 Attitude errors in roll, pitch and azimuth for GPS/INS integrated system in case of 1sec. GPS update rate. 

Figure. 11 Navigation result in lat/lon for GPS/INS integrated system in case of 1sec. GPS update rate. 

5.2. Navigation results during 10 sec GPS outage

In this section, we made a test to validate our proposed technique during the GPS denied environment by simulate a tunnel crossing or an urban canyon crossing via 10 second GPS data outage. In this case we noticed that the accumulated INS positioning errors increase rapidly during the outage interval. Then we started our proposed technique test based on a real time solution with attitudes and odometer aiding and we referred to this case by (RTS with attitude and odo aiding) , then we compared our proposed case with other two cases which are RTS without aiding and RTS with attitude aiding. In our proposed case in addition to using the attitude aiding we used the odometer sensor to collect the velocity measurements of the land vehicle instead of GPS velocity during the GPS outage. In case of RTS with attitude and odometer aiding we found that the performance of the integrated system has been improved as clearly shown in a comparison between the quantitative position errors such as standard deviation, mean, maximum error in east and north positions and the maximum horizontal error (MHE), these quantitative position errors were found decreased. As we notice from the comparison in Table 2 and as shown in Figure 12, we will find that The MHE is equal to 161.945 (m) during 10 second GPS outage without any kind of aiding then we will see that the position error dramatically damp due to the enhancement which occurred in the attitude channels after attitude aiding with the INS data and the MHE reduced by 87.205 %; while, after we added the measurement velocity from the odometer sensor and vehicle constrains to the aforementioned RTS with attitude adding then the MHE reduced by 92.74 % and this comparison clearly prove that the localization solution will be more accurate in case of our proposed technique when UKF integration done after using the improved pitch and roll angles as an output of CF and using the heading angle from the magnetic compass in addition to utilizing the velocity from the odometer velocity. Figures 13-14 show the improvements which happened in the navigation resultant and verify our proposed MSDF technique to be a suitable for solving the problem of real time land vehicle localization. From Table 2 we can notice that the utilized extremely low-cost and grade of IMU as an inertial sensor is suitable for low-cost integrated navigation systems of land vehicle applications which tolerate a 2D position with a maximum horizontal error (MHE) of about 11.75 meters in case of GPS not available.

Table 2 Position errors during navigation in case of 10sec GPS outage. 

Position errors (m) for 10sec. GPS outage
Mean Std. Max. Error Max. Horizontal Error
RTS without aiding East 1.789 9.81 116.2 161.945
North 1.96 9.17 112.8
RTS with attitude aiding East 0.476 1.66 17.51 20.721
North 0.646 1.22 11.08
RTS with attitude & odo. Aiding East 0.337 0.72 6.342 11.750
North 0.623 1.09 9.892

Figure 12 Position errors in east/north for GPS/INS integrated system in case of 10sec GPS outage. 

Figure 13 Navigation result in lat/lon for GPS/INS integrated system in case of 10sec GPS outage. 

Figure 14 Attitude errors in Roll, Pitch and Azimuth for GPS/INS integrated system in case of 10sec GPS outage 

6. Conclusions

In this paper a real time nonlinear MSDF solution based on extremely low-cost and grade inertial sensor for land vehicle navigation system is presented. The utilized low-cost inertial sensor-based MEMS are IMU, commercial GPS, CAN bus (OBD) shield which senses the vehicle velocity and digital magnetic compass sensors. Loosely coupled integration architecture based on two platforms of 32-bit ARM core microcontroller and one platform of 16-bit AVR ATMEL microcontroller using UKF has been implemented. The integrated mechanism has been implemented and its performance has been evaluated through real time experimental work and post-processing domain.

A complementary filter (CF) has been implemented to improve the tilt angle drift. In case of available GPS conditions, the performance of the integrated system and the accuracy of the estimated localization state have been improved by using the RTS method with attitude aiding and the MHE errors reduced by 45.354 %. In case of GPS-denied environments, the proposed integrated mechanism based on RTS with attitude and odometer with vehicle constrains aiding is presented and the MHE reduced by 92.74 %. The proposed mechanism overcome the rapidly increasing navigation errors due to GPS outage and ensure a land vehicle continuous navigation solution with high performance accuracy comparable with RTS without aiding technique and RTS with attitude aiding technique. The results of the real-time experiment show the performance of the proposed technique based on UKF applied to the nonlinear system without linearization of the state model. Finally, the paper showed that the low-cost hardware based on ARM core microcontroller can handle the computational complexity of performing the unscented transformation process and the calculations of the proposed algorithm with good output navigation results compared with the reference trajectory.

References

Aftatah, M., Lahrech, A., Abounada, A., & Soulhi, A. (2016). GPS/INS/Odometer data fusion for land vehicle localization in GPS denied environment. Modern Applied Science, 11(1), 62. https://doi.org/10.5539/mas.v11n1p62 [ Links ]

Aggarwal, P., El-Sheimy, N., & Noureldin, A. (2010). MEMS-based Integrated Navigation. Artech House. [ Links ]

Ahmed, H., & Tahir, M. (2017). Accurate Attitude Estimation of a Moving Land Vehicle Using Low-Cost MEMS IMU Sensors," in IEEE Transactions on Intelligent Transportation Systems , vol. 18, no. 7, pp. 1723-1739. https://doi.org/10.1109/TITS.2016.2627536 [ Links ]

Eldesoky, A., Kamel, A. M., Elhabiby, M., & Elhennawy, H. (2017a). Positioning Accuracy Improvement Using Low-Cost Inertial Sensors", 10th International Conference on Mobile Mapping (MMT2017), Cairo, pp. 81-85. [ Links ]

EIdesoky, A., Kamel, A., Elhabiby, M., & Elhennawy, H. (2017b). Performance Enhancement of Low-Cost MEMS Inertial Sensors Using Extensive Calibration Technique. 34th National Radio Science Conference https://doi.org/10.1109/NRSC.2017.7893511 [ Links ]

El-Sheimy, N., & Youssef, A. (2020). Inertial sensors technologies for navigation applications: state of the art and future trends. December 2020 Satellite Navigation 1(1), 2. https://doi.org/10.1186/s43020-019-0001-5 [ Links ]

Hazry D. & Zul A. (2009). Study of Inertial Measurement Unit Sensor. International Conference on Man-Machine Systems (ICoMMS). [ Links ]

Hieu, L. N., & Nguyen, V. H. (2012). Loosely coupled GPS/INS integration with Kalman filtering for land vehicle applications. 2012 International Conference on Control, Automation and Information Sciences (ICCAIS) (pp. 90-95). IEEE. https://doi.org/10.1109/iccais.2012.6466637 [ Links ]

LaViola, J. J. (2003). A comparison of unscented and extended Kalman filtering for estimating quaternion motion. Proceedings of the 2003 American Control Conference, 2003. (Vol. 3, pp. 2435-2440). IEEE. https://doi.org/10.1109/acc.2003.1243440 [ Links ]

Julier, S. J., Uhlmann, J. K., & Durrant-Whyte, H. F. (1995). A new approach for filtering nonlinear systems. Proceedings of 1995 American Control Conference - ACC’95. (Vol. 3, pp. 1628-1632). IEEE. https://doi.org/10.1109/acc.1995.529783 [ Links ]

Julier, S. J., & Uhlmann, J. K. (1997). New extension of the Kalman filter to nonlinear systems. Signal Processing, Sensor Fusion, and Target Recognition VI. (Vol. 3068, pp. 182-193). https://doi.org/10.1117/12.280797 [ Links ]

Maklouf, O., Ghila, A., Abdulla, A., & Yousef, A. (2013). Low Cost IMU\GPS Integration Using Kalman Filtering for Land Vehicle Navigation Application. International Journal of Electrical, Computer, Energetic, Electronic and Communication Engineering, 7(2), 184-190. [ Links ]

Noureldin, A., Karamat, T. B., & Georgy, J. (2012). Fundamentals of inertial navigation, satellite-based positioning and their integration. Springer Science & Business Media. [ Links ]

Penn, T. R. (2012). All Source Sensor Integration Using an Extended Kalman Filter.Master’s. Thesis, Air Force Institute of Technology, Wright-Patterson AFB, OH, USA. [ Links ]

Van der Merwe, R., Wan, E., & Julier, S. (2004). Sigma-Point Kalman Filters for Nonlinear Estimation and Sensor-Fusion: Applications to Integrated Navigation. AIAA Guidance, Navigation, and Control Conference and Exhibit. https://doi.org/10.2514/6.2004-5120 [ Links ]

Shin, E. H. (2005). Estimation techniques for low-cost inertial navigation. UCGE report, 20219. [ Links ]

Sukkarieh, S. (1999). Aided Inertial Navigation Systems for Autonomous Land Vehicles. PhD thesis, Australian Centre for Field Robotics, The University of Sydney. [ Links ]

Wan, E. A., & Van Der Merwe, R. (2000). The unscented Kalman filter for nonlinear estimation. In Proceedings of the IEEE 2000 Adaptive Systems for Signal Processing, Communications, and Control Symposium (Cat. No. 00EX373) (pp. 153-158). Ieee. https://doi.org/10.1109/ASSPCC.2000.882463 [ Links ]

Wan, E. A., Van Der Merwe, R., & Haykin, S. (2001). The unscented Kalman filter. Kalman filtering and neural networks, 5(2007), 221-280. [ Links ]

Xu, Q., Li, X., Li, B., Song, X., & Cai, Z. (2016). A Reliable Hybrid Positioning Methodology for Land Vehicles Using Low-Cost Sensors. IEEE Transactions on Intelligent Transportation Systems , 17(3), 834-847 https://doi.org/10.1109/tits.2015.2487518 [ Links ]

Zhang, Q., & Niu, X. (2018). Research on accuracy enhancement of low-cost MEMS INS/GNSS integration for land vehicle navigation. 2018 IEEE/ION Position, Location and Navigation Symposium (PLANS). https://doi.org/10.1109/plans.2018.8373467 [ Links ]

Peer Review under the responsibility of Universidad Nacional Autónoma de México.

Received: January 04, 2020; Accepted: March 02, 2020; Published: August 31, 2020

Corresponding author. E-mail address:a_dosoky123@yahoo.com (Abdalla Eldesoky).

Creative Commons License This is an open-access article distributed under the terms of the Creative Commons Attribution License