Improved Inertial/Odometry/GPS Positioning of Wheeled Robots Even in GPS-Denied Environments

Eric North1, Jacques Georgy2, Umar Iqbal3, Mohammed Tarbochi4 and Aboelmagd Noureldin5 1Canadian Forces Aerospace and Telecommunications Engineering Support Squadron 2Trusted Positioning Inc. 3Electrical and Computer Engineering Department, Queen’s University 4Electrical and Computer Engineering Department, Royal Military College 5Electrical and Computer Engineering Department, Royal Military College/Queen’s University Canada


Introduction
As described by Pacis et al (Pacis et al., 2004) the control strategy from a navigational viewpoint used in a mobile platform ranges from tele-operated to autonomous.A tele-operated platform is a platform having no on-board intelligence and whose navigation is guided in real-time by a remote human operator.An autonomous platform is one that takes its own decisions using onboard sensors and processor.According to Pacis et al (Pacis et al., 2005) for autonomous mobile robot navigation the problems that must be dealt with are localization, path planning, obstacle avoidance and map building.The focus of this work is in the localization problem.
Localization is the problem of estimating robot's pose relative to its environment from sensor observations.Localization is a necessity for successful mobile robot systems, it has been referred to as "the most fundamental problem to providing a mobile robot with autonomous capabilities" (Cox, 1991).Furthermore, as confirmed in (Pacis et al., 2004) to achieve autonomous navigation the robot must maintain an accurate knowledge of its position and orientation.Successful achievement of all other navigation tasks depends on the robot's ability to know its position and orientation accurately.According to a review by Borenstein et al (Borenstein et al., 1997) of mobile robot positioning technologies, positioning systems are divided into seven categories falling in two groups.They classified the positioning techniques as: relative position measurement and absolute position measurement.The former includes odometry and inertial navigation while the latter includes magnetic compass, active beacons, global positioning system (GPS), landmark navigation and map-based positioning.
An unprecedented surge of developments in mobile robot outdoor navigation was witnessed after the US government removed selective availability (SA) of GPS.Examples of applications for these robots are autonomous lawnmowers and motorized wheelchairs.These devices are low-cost and are used on terrain that is not flat.GPS can be used to provide three-dimensional knowledge of the mobile robot's position.Unfortunately, GPS suffers from outages when line-of-sight is blocked between the robot and GPS satellites.These outages are caused by operating the robot in and around buildings, dense foliage and other obstructions.An inertial measurement unit (IMU), with three accelerometers and three gyroscopes, is a good choice in lieu of GPS during outages for providing a 3-D positioning solution.Since a low-cost solution is needed for certain mobile robots, a low-cost IMU based on a micro electro-mechanical system (MEMS) has to be used.However, MEMS-based inertial sensors suffer from several complex errors such as biases; moreover these errors have influential stochastic parts.Since inertial navigation systems (INS) involve integration operations using sensor readings, the subsequent errors will accumulate and cause a rapid degrade in the quality of position estimate.Odometry using wheel encoders is another type of dead reckoning that provides limited localization information, mostly two-dimensional (2-D).This information is not subject to the same magnitude of errors as the IMU, provided that the vehicle does not encounter excessive skidding or slipping.But these 2-D solutions will not be adequate if the robot often moves outside the horizontal plane.
While 2-D and 3-D solutions using sensors in a full-sized vehicle have been done in the work to-date, further research is needed in the area of 3-D localization of small wheeled mobile robots operating in large 3-D terrain.The majority of the previous work using small mobile robots shows that the terrain is flat and the paths of the robots are small (for example (Ohno et al., 2003) (Ollero et al., 1999) (Chong & Kleeman, 1997)).This work attempts to bridge the gap between full-sized vehicle navigation in 3-D and navigation of small wheeled mobile robots over large paths in uneven terrain.Furthermore, this work will provide a 3-D solution for a small wheeled mobile robot that is required to travel distances in excess of 1 km over hilly terrain.
This work aims at combining the advantages of inertial sensors and odometry while mitigating their disadvantages to provide enhanced low-cost mobile robot 3-D localization capabilities during GPS outages.This will be achieved through the use of a Kalman Filter (KF) that integrates odometry from wheel encoders, low cost MEMS-based inertial sensors and GPS in a loosely-coupled scheme.To enhance the performance and lower the cost further, the proposed technique uses a reduced inertial sensor system (RISS).To further enhance the solution during GPS outages, velocity updates computed from wheel speeds are used to reduce the drift of the estimated solution.Moreover, this work proposes the development of a predictive error model used in a KF for estimating the errors in positions, velocities and azimuth angle from RISS mechanization.The experimental results will show that this error model when combined in a KF with 3-D measurement updates of velocities using forward speed from encoders together with pitch and azimuth estimates is a good technique for greatly reducing localization errors.

Reduced inertial sensor system
In addition to MEMS-based sensors, the concept of RISS is used in a navigation scheme for a full-sized vehicle (Iqbal et al., 2008) in order to further lower the cost of the positioning solution.The RISS used in (Iqbal et al., 2008) involves a single-axis gyroscope and two-axis accelerometer together with a built-in vehicle speed sensor to provide a 2-D navigation solution in denied GPS environments.With the assumption that the vehicle remains mostly in the horizontal plane, the vehicleï£¡s speed sensor is used with heading information obtained from the vertically-aligned gyroscope to determine the velocities along the East and North directions.Consequently, the vehicles longitude and latitude are determined.If pitch and roll angles are needed the two accelerometers pointing towards the forward and transverse directions are used together with odometer-derived speed and a reliable gravity model to determine these angles independently of the integration filter.In (Iqbal et al., 2009), 2-D RISS/GPS integration were presented using Kalman filter (KF) for a full-sized vehicle.
In this work a low-cost navigation system using a KF to integrate MEMS-based RISS with GPS in a loosely-coupled scheme is described.The RISS used herein is 3-D: it includes a three-axis accelerometer and a single-axis gyroscope aligned with the vertical axis of the body frame of the robot together with two wheel encoders.Here accelerometers are used to calculate 3-D velocity and position while the vertical gyroscope is used to calculate the azimuth angle (i.e. the heading of the robot).Pitch and roll are calculated based on the idea presented in (Noureldin et al., 2002) (Noureldin et al., 2004) using the two horizontal accelerometers and the forward velocity obtained from wheel encoders.This constitutes the RISS mechanization.
The benefits of eliminating the other two gyroscopes in this RISS mechanization scheme are as follows: (1) further decreases in system costs and (2) improvements in positioning accuracy by employing fewer inertial sensors and thus less contribution of sensor errors towards positional errors.Of particular importance is the reduction in error in pitch and roll calculations.Whereas full mechanization of pitch and roll from gyroscopes involves integration, their calculation in RISS mechanization using accelerometers does not.This last fact decreases the portion of positional error originating from pitch and roll errors.

Coordinate transformation from local level lram (LLF) to body frame (B-F)
The local level frame (LLF) serves to represent mobile robot attitude and velocity for operation on or near the surface of the earth and is defined as an origin, x, y and z-axis.The origin coincides with the center of the sensor frame (origin of inertial sensor triad).The y-axis points to true north.The x-axis points to east.Finally, the z-axis completes the right-handed coordinate systems pointing up, perpendicular to the reference ellipsoid.
One of the important direction cosine matrices for specifying rotation between one coordinate frame to another is R l b which transforms a vector from b-frame to LLF, a requirement during the mechanization process.R l b is expressed in terms of yaw, pitch and roll Euler angles is defined as: (1)

Mobile robot odometry equation
The conventions and notation presented in (Chong & Kleeman, 1997) are used to create a kinematic model for the mobile robot.In this work, a simple model for mobile robot kinematics is considered.The wheels must be as thin as possible (one rolling point-of-contact between the terrain and each wheel).Also, there must not be any slipping along the longitudinal direction.There must not be any sliding along the transverse direction.
Define the instantaneous center of curvature (ICC) as a means of describing the curvilinear motion that the mobile robot makes on a plane.In a two-dimensional environment the plane that the robot travels on remains fixed for all possible positions and orientations of the mobile robot (some authors refer to the reference frame enclosed in this plane as the "global reference frame" (Chong & Kleeman, 1997).In this work, motion of the mobile robot on possibly distinct planes for each time interval is considered.The mobile robot travels on a plane that is fixed where: V T k is the velocity of the robot measured from its center and tangent to the circular path contained on a plane from time k − 1 ≤ t ≤ k + 1; r R is the radius of the right drive wheel; r L is the radius of the left drive wheel; ω R k is the angular velocity of the right drive wheel from time k − 1 ≤ t ≤ k + 1; ω L k is the angular velocity of the left drive wheel from time k − 1 ≤ t ≤ k + 1; k represents discrete time epochs; and ∆t is the sampling time.
Rotational speeds of the left and right drive wheels are measured using encoders which are used to calculate the forward velocity of the robot.The forward velocity is transformed into velocities in the local frame using the equations below.Equation 2 is expressed in the mobile robot frame.In order for us to use the velocities of the robot's wheels as a measurement update we must transform these quantities to the local frame.Using the following transformation we have: Global Navigation Satellite Systems -Signal, Theory and Applications www.intechopen.com

Attitude equations
The equations for calculating pitch and roll from accelerometers are based on the idea presented in (Noureldin et al., 2002) (Noureldin et al., 2004).The robot acceleration derived from wheel encoder measurements is removed from the forward accelerometer measurement before computing the pitch angle.The equation for pitch ρ and neglecting acceleration in the forward direction since the robot travels at very low speeds is as follows: Where: f y is the forward accelerometer reading; g is the acceleration due to gravity; and a f is the forward acceleration and is derived from the forward velocity of the robot calculated from the average velocity measured by the wheel encoders from Equation 2.
The transverse accelerometer has to be compensated for the normal acceleration of the vehicle and then it is used to calculate the roll angle.
The equation for roll θ: Where: f x is the transversal accelerometer reading; and ω z is the vertical gyroscope reading.
The equation for the time-rate-of-change of yaw according to (Iqbal et al., 2009) using the previous value for V e from RISS mechanization: Integrating in discrete time gives us:

Velocity equations
There are three accelerometers that can be used to measure acceleration in the body frame of the mobile robot.Use these acceleration values to compute a velocity increment in the current time-step in order to compute an estimate for velocities.Use roll, pitch and yaw to calculate a rotation matrix R l b from the body frame to the local frame in Equation 1. Calculate a skew-symmetric matrix ω l ie for the earth's rotation rate since the last velocity calculation.In addition, calculate the skew-symmetric matrix ω l el for the LLF change-of-orientation since last calculation.

261
Improved Inertial/Odometry/GPS Positioning of Wheeled Robots Even in GPS-Denied Environments www.intechopen.comUsing R l b from Equation 1, calculate the skew-symmetric matrix for earth rotation rate ω l ie since the last velocity calculation: −ω e sin φω e cos φ ω e sin φ 00 −ω e cos φ 00 In addition, calculate the skew-symmetric matrix for the L-frame change of orientation ω l el since last calculation: Use the following equation to provide velocity increments of the mobile robot in the body frame: With the three matrices R l b , ω l ie and ω l el , the effect of gravity in the local frame in addition to the body-frame velocity increments ∆ V b the new velocities are calculated by determining the rate-of-change for velocity increments ∆ V l in the local frame as follows: Where g l = [00 − g] T .Integration is performed using the previous values for velocities V l at time k − 1toget V l at time k using ∆ V l as follows:

Position equations
The equations for altitude h, latitude φ and longitude λ are as follows: It should be noted that any uncompensated bias or drift error in the accelerometer data will lead to growing errors when integrating acceleration to get velocity and again when integrating to get position.Furthermore, any uncompensated bias or drift error in the vertical gyroscope reading will lead to error growth when integrating to get yaw and again (together with velocity) to get position.

262
Global Navigation Satellite Systems -Signal, Theory and Applications www.intechopen.com

Kalman filtering
KF is the most commonly used technique for INS/GPS integration (Farrell & Barth, 1998) (Grewal et al., 2007).fig 1 shows a top-level view of the KF-based system used in this chapter for outdoor mobile robot localization.As mentioned previously, a loosely-coupled integration scheme is adopted in this chapter.
Fig. 1.An overview of the KF-based system used for outdoor mobile robot localization.

Error state vector
Since KF requires linearized models it estimates the error state not the navigation states themselves.The errors in the navigation states estimated by the filter are then used to correct the mechanization output and provide corrected navigation states.Leveraging the benefits of wheel encoders during GPS outages the KF presented in this section uses an error vector containing eleven states.
The linearized error-state system model used by the KF in this work is in the form: The error state vector in Equation 18 consists of position errors (for latitude, longitude and altitude), velocity errors (along East, North and vertical Up), yaw error and inertial sensor stochastic drift for the single gyroscope and three accelerometers: The following sections contain derivations of the equations for each error state in the model.These equations use first order terms from the Taylor series expansion of the mechanization equations.

Position errors
From (Noureldin et al., 2009) the position components of the mechanization equations are linearized, yielding three error equations for latitude, longitude and altitude.Neglecting higher-order terms of the Taylor Series and writing in matrix form gives: Where M and N are the respective Meridian and normal radii of the curvature of the Earth.

Velocity errors
The velocity components from the mechanization equations are linearized to provide velocity error equations; these equations are presented in (Noureldin et al., 2009).The velocity errors are function of errors in position, velocity, and attitude as well as accelerometer stochastic drift errors.
In this work the errors in pitch δρ and δθ roll are not modelled inside the KF.This is because they don't suffer from error growth due to lack of integration operations.Therefore there are no dynamic error states for pitch and roll errors.Instead, expressions for δρ and δθ in δ ˙ V l composed of other error states and pitch and roll equations in RISS mechanization are derived.The equation for velocity error is then re-arranged to accommodate the error terms belonging to δρ and δθ.
The following is a derivation for the expression for δρ in Equation 21 using Equation 6.Take the derivative of the error component of ρ to give δρ: A similar operation is performed for the error in roll, keeping in mind that the aim is to find an alternate expression for δθ that contains error terms other than δθ and δρ.Using Equation 7, the partial derivatives of each component of θ in Equation 21 are used to give: Where δθ = δV f δρ δω z δ f x T . Taking partial derivatives results in: (24) Express δρ and its associated terms in Equation 24 using the components from Equation 22 as follows: Express δV f contained in δθ from Equation 24 in terms of the three velocities along the east, north and up channels: Using Equations 25 and 26, Equation 24 can be rewritten as: Using Equations 22 and 27 the equation for the attitude components of the velocity error can be re-arranged to accommodate the error terms belonging to ρ and θ.Similar terms will be grouped to produce a set of equations that describe the attitude errors within δ ˙ V l .The term δ ˙ V l att will be used to describe the attitude-portion of the velocity errors states.Once the equation for the components of velocity errors due to attitude errors is described it can be easily combined with the other terms in the velocity error states.
Experimental data shows that the forward speed originating from the encoders does not suffer from stochastic errors such as stochastic scale factor.This is due to the fact that the robot's 266 Global Navigation Satellite Systems -Signal, Theory and Applications www.intechopen.comwheels are essentially rigid.Therefore the error in forward speed δV f contained in δθ T is expressed as a white noise term using the standard deviation of δV f .The standard deviation is added to the process noise coupling state vector G.

Heading error
As mentioned earlier, pitch and roll do not have an error model in this work.This is because errors in pitch and roll do not accumulate as for the other measurements due to a lack of integration operations.To obtain an expression for heading error, use the yaw expression from mechanization for yaw ψ and linearize it by taking the first order terms in the Taylor series expansion.An expression for the error in yaw (and consequently azimuth) is determined:

Measurement model
Section 2.5.1 described the error-state system model for the KF.The KF also needs a measurement model to be used in the update stage.There are two measurement update models used in this work.The first is when GPS is available and the second is used when there is a GPS outage.During GPS availability both GPS position and velocity are used and the differences between the RISS mechanization position and velocity and those of GPS are used as a measurement.The measurement model is as follows: Where the measurement state vector z GPS k is defined as: The design matrix H is: And v GPS k is a white noise process with zero mean and unity variance.When GPS is not available, forward velocity derived from the wheel encoders together with pitch and azimuth estimates are used as a measurement update.The measurement model is as follows: Where the measurement state vector z odo k is defined as: The design matrix H is: And v odo k is a white noise process having zero mean and unity variance.

Wheeled mobile robot
Outdoor trajectory tests are conducted to assess the performance of the developed navigation solution; the tests are conducted using a mobile robot shown in fig 2. The robot was developed by a member of NavINST and members of the Electrical and Computer Engineering Department (ECE) at Royal Military College (RMC) of Canada.The mobile robot is three-wheeled and differentially-driven with a quadrature optical encoder coupled to the drive outputs of each motor.Appropriate scaling in the navigation scheme is used to provide angular velocity estimates of each wheel from these encoders.Power on-board the mobile robot comes from three sources, namely (1) two 12V batteries connected to the drive amplifiers and motors, (2) two 12V batteries connected to the sensors and encoder processor board and (3) a battery internal to the laptop mounted on the top level of the robot.

Equipment
The inertial sensors used in this work include a MEMS-grade IMU made by Crossbow, model IMU300CC-100.Specifications of this IMU are in table 1 and detailed specifications can be found in (IMU300CC -6DOF Inertial Measurement Unit, 2009).Velocity updates are provided by the forward speed of the robot, derived from encoders coupled to the drive output of each motor.The results of the presented navigation solution are evaluated with respect to a reference solution made by NovAtel where a Honeywell HG1700 high-end tactical grade IMU is integrated with a NovAtel OEM4 GPS receiver.The IMU and GPS receiver are integrated with a G2 Pro-Pack SPAN unit which is an off-the-shelf system developed by NovAtel.The details of this system are described in (SPAN Technology System User Manual OM-20000062, 2005).Biases and scale factors for the HG1700 IMU are in table 2 and detailed specification can be found in (HG1700 Inertial Measurement Unit, 2009).The high-cost NovAtel SPAN system provides a reference solution to validate the proposed method which uses the low-cost MEMS-based sensors.The SPAN system is also used to examine the overall performance during some GPS outages intentionally introduced in post-processing.A basic block diagram of the sensor electronics on-board the mobile robot appears in fig 3.

Results and discussion
Trajectories are carried out using the mobile robot described in Section 3 and sensor data is collected to test the developed solution in post-processing.Four navigation solutions are compared in order to show the benefit of using RISS instead of a full IMU and the benefit of   using velocity updates from wheel encoders during GPS outages.Each of the four navigation solutions are described as follows: KF using RISS and velocity updates during GPS outages; KF using RISS without updates during outages; KF using full IMU with velocity updates during outages; and KF using full IMU without updates during outages.
The errors in all the estimated solutions are calculated with respect to the NovAtel reference solution.Results for two trajectories are shown in this work.The first trajectory is shown in fig 4 and is located on-campus at RMC.It forms a loop with start and end at the same position and contains two different sections with hills both at an incline and decline to the robot's trajectory.
The second trajectory for this experiment is shown in fig 5 and is also located on-campus at RMC.This trajectory forms a loop with start and end at the same position and is much longer than the trajectory in fig 4. It contains several different sections which include hills both at an incline and decline to the robot's trajectory.

Trajectory 1
The ultimate check for the proposed systemï£¡s accuracy is during GPS signal blockage which can be intentionally introduced in post-processing.Since the presented solution is loosely coupled the outages represent complete blockages of GPS updates.Seven GPS outages are simulated with durations of 60 seconds each.The simulated outages are chosen such that they encompass straight portions, turns, and slopes.
Table 7 shows the root mean square (RMS) error in both the estimated 2-D horizontal position and the estimated altitude during seven GPS outages for the four compared solutions.The The results in table and fig 6 clearly show the advantage of RISS over a full IMU.There is a big difference in 2-D positional errors when one compares the results of KF with full IMU without updates with the results of KF with RISS without updates during GPS outages.While the former has an average of the maximum positional error for the seven GPS outages equal to 139.3 meters, the latter shows an error of 18.67 meters.The reason for this difference is the use of accelerometers vice the two gyroscopes used to get pitch and roll from the RISS.Fig. 6.Three solutions and reference for first trajectory: Red for reference, Yellow for KF using full IMU with velocity updates, Green for KF using RISS without updates, Blue for KF using RISS with velocity updates.When comparing KF with RISS and velocity updates to KF with full IMU and velocity updates the advantage of RISS can be clearly noticed.The former has an average of the maximum positional error for the seven GPS outages equal to 3.35 meters while the latter shows an error of 8.77 meters.
These results together with the trajectory plots in fig 6 demonstrate that the proposed 3-D localization solution using KF for RISS/GPS integration and employing velocity updates using wheel encoders outperforms all the other compared solutions.Furthermore this solution provides very good results when compared to the MEMS-based INS/GPS integration results in the literature.

Trajectory 2
The second trajectory is much longer than the first one and enables the examination of long GPS outages.Seven outages are simulated with the duration of each outage equal to 150 seconds.This duration is chosen to test the performance of the proposed navigation solution in long GPS outages.The simulated outages are also chosen such that they encompass straight portions, turns and slopes.
Table 10 shows the root mean square (RMS) error in both the estimated 2-D horizontal position and the estimated altitude during the seven GPS outages for the four compared solutions.As seen in the first trajectory the benefit of using velocity updates during GPS outages derived from the wheel encoders is seen by two comparisons.The first comparison uses KF with full IMU and considers two sets of results, one with and the second without velocity updates.
With velocity updates the solution has an average of the maximum positional error for the seven GPS outages equal to 11.44 meters while the case without updates has 789.2 meters of error.
Fig. 9. Three solutions and reference for second trajectory: Red for reference, Yellow for KF using full IMU with velocity updates, Green for KF using RISS without updates, Blue for KF using RISS with velocity updates.the maximum positional error for the seven GPS outages equal to 7.64 meters while the case without updates has 68.29 meters of error.
When comparing KF with RISS and velocity updates to KF with full IMU and velocity updates the advantage of RISS can be seen especially in the altitude component.The former has an average of the maximum positional error for the seven GPS outages equal to 7.64 meters while the latter shows an error of 11.44 meters.The former has an average of the maximum altitude error for the seven GPS outages equal to 3.68 meters while the latter shows an error of 19.53 meters.
These results together demonstrate that the 3-D localization solution using KF for RISS/GPS integration and employing velocity updates using wheel encoders outperforms all the other compared solutions.Furthermore this solution provides very good results when compared to the MEMS-based INS/GPS integration results in the literature.

Conclusion and future work
This chapter presented an outdoor 3-D localization solution for mobile robots using low-cost MEMS-based sensors, wheel encoders and GPS.A reduced inertial sensor system was used for both decreasing the cost and improving the performance.The integration was achieved using a loosely-coupled KF.In this work, a predictive error model for KF was developed for estimating the errors in positions, velocities and attitude provided by RISS mechanization.Using this error model inside the KF gives good results during GPS outages that outperformed the full IMU results.Furthermore, when this KF is used with measurement updates using forward velocity from encoders together with pitch and azimuth estimates (during GPS outages) it provides better results and outperforms all the compared solutions.
The positioning solutions in this work were tested with two real trajectories with seven simulated GPS outages whose duration was 60 seconds in the first trajectory and 150 seconds in the second trajectory.The proposed solutions were discussed and compared with each solution also compared against a reference solution.One problem unique to small wheeled robots with strap-down navigation systems is that there is a great deal of chassis rigidity that passes along any disturbances felt at the wheels of the robot.Small, low-cost robots do not have suspension systems found on full-size vehicles which prevent many disturbances from being measured by the accelerometers of a strap-down IMU.A future investigation is required regarding low-cost measures for dampening some of the vibrations caused by small obstacles and imperfections on the road surface.Prospective researchers should make a careful selection of tires for their small mobile robot that allow moderate deformation to small obstacles while preserving sufficient shape to maintain reliable estimates for velocities measured by the wheel encoders.
Kalman filtering is a good technique for reducing the stochastic error of a system since it requires little processing time compared to other algorithms.It is a suitable choice for deployment in low-cost, low-power, low-form-factor systems such as those found on small mobile robots.Further study is required to determine the performance of the techniques outlined in this work in the context of an embedded system operating in real-time.

263
Improved Inertial/Odometry/GPS Positioning of Wheeled Robots Even in GPS-Denied Environments www.intechopen.com Odometry/GPS Positioning of Wheeled Robots Even in GPS-Denied Environments www.intechopen.com Odometry/GPS Positioning of Wheeled Robots Even in GPS-Denied Environments www.intechopen.com

268
Fig. 2. The mobile robot used for the experiments in this work, custom-built by the author and members of the Electrical and Computer Engineering Department at Royal Military College of Canada.

269
Improved Inertial/Odometry/GPS Positioning of Wheeled Robots Even in GPS-Denied Environments www.intechopen.com

Fig. 3 .
Fig. 3. Block diagram for the electronics on-board the mobile robot used in the experiments.

Fig. 4 .
Fig. 4. The first trajectory for assessing each navigation solution.

Fig. 7 .
Fig. 7. RMS errors for altitude and 2D position for the seven outages in first trajectory.The benefit of using wheel encoders to provide velocity updates during GPS outages can be seen by two comparisons.The first comparison uses KF with full IMU and considers two sets of results, one with and the second without velocity updates.With velocity updates the solution has an average of the maximum positional error for the seven GPS outages equal to 8.77 meters while the case without updates has 139.3 meters of error.The second comparison uses KF with RISS and considers two sets of results, one with and the second without velocity updates.With velocity updates the solution has an average of the maximum positional error for the seven GPS outages equal to 3.35 meters while the case without updates has 18.67 meters of error.

Fig. 10 .
Fig. 10.RMS errors for altitude and 2D position for the seven outages in second trajectory.The second comparison uses KF with RISS and considers two sets of results, one with and the second without velocity updates.With velocity updates the solution has an average of

Table 2 .
Bias, scale factor error and random walk for the Honeywell HG1700 IMU found in Novatel GPS/INS.Adapted from SPAN Technology System User ManualOM-20000062 (2005)and HG1700 Inertial Measurement Unit (2009).
Table11shows the maximum errors in the estimated 2-D horizontal position and the estimated altitude during each outage.fig9showsa2-D plot of four tracks, namely: (1) reference solution, (2) KF with full IMU and velocity updates during GPS outages, (3) KF with RISS and without updates during outages and (4) KF with RISS and velocity updates during outages.As mentioned earlier the KF with full IMU and without updates during GPS outages is not shown because the position errors would dramatically change the scale of the plot and make comparison of the other solutions very difficult.The results in table 10 and table 11 confirm the results of the first trajectory and they further demonstrate the advantage of RISS over a full IMU.One can see a great difference in 2-D positional errors when comparing the results of KF with full IMU without updates with the results of KF with RISS without updates during during GPS outages.While the former technique has an average of the maximum positional error for the seven GPS outages equal to 274 Global Navigation Satellite Systems -Signal, Theory and Applications www.intechopen.com789.2 meters the latter shows an error of 68.29 meters.The reason for this huge enhancement of performance is the use of accelerometers vice the two gyroscopes used to get pitch and roll from the RISS.
Considering the maximum error in horizontal positioning in the first trajectory, the KF with RISS and velocity updates during GPS outages achieved an average improvement of approximately 97.6% over KF with full IMU without any updates during outages, of approximately 61.8% over KF with full IMU 276 Global Navigation Satellite Systems -Signal, Theory and Applications www.intechopen.comwith velocity updates during outages, and of approximately 82.0% over KF with RISS without any updates during outages.Considering the maximum error in horizontal positioning in the first trajectory, the KF with RISS and velocity updates during GPS outages achieved an average improvement of approximately 99.0% over KF with full IMU without any updates during outages, of approximately 33.2% over KF with full IMU with velocity updates during outages, and of approximately 88.8% over KF with RISS without any updates during outages.These results show the superiority of the proposed localization solution.