GPS integrated with inertial sensors in mobile phones becomes a reality
The paper presents the development of portable car navigation system that can provide continuous reliable positioning even when GPS signals are not available
Accurate and continuous position computation is a key task for vehicle navigation and telematics applications. In most portable car navigation and telematics devices, the position is determined based only on GPS data. However, in urban canyons stand-alone GPS suffers signal masking and reflections of the signal from buildings, large vehicles, and other reflective surfaces. Driving tests in such metropolises as Hong Kong, Tokyo, and New York show that the chance of receiving four GPS satellites required for navigation can be as low as 20% of total driving time . Even when four or more satellites are available, strong multipath effect might cause a positioning error of more than 100 m.
In order to obtain uninterrupted navigation data in urban environment, GPS data can be augmented with a complementary navigation system that can work continuously in any type of urban environment . This is known as an integrated navigation system. This article presents such an integrated GPS/ DR (Dead Reckoning) navigation system. We consider a DR configuration consisting of one gyro for directional measurements and 3D accelerometer. Both the gyro and accelerometers satisfy the requirements for mass market portable consumer devices: low cost, light weight, and low power consumption. An odometer is not used in the proposed system as it requires additional car installation; this system is intended mainly for portable devices such as mobile phones, GPS-based peripherals, and handheld GPS navigation devices. This paper shows how GPS data can be augmented with DR sensor data using an Extended Kalman Filter (EKF) to achieve the required navigation performance in urban environment. In the proposed system, the DR sensors are calibrated when GPS is available. If GPS signal is not available or GPS position accuracy suffers from multipath, the calibrated DR sensors are used to determine the position of the vehicle. Our field tests with a real-time prototype show that the proposed method improves the performance of vehicle positioning in high multipath signal environments and during short GPS signal outages.
The proposed car navigation system includes different types of navigation sensors and technologies. Our concept of data fusion from multiple sensor technologies is illustrated in Fig. 1.
This methodology comprises several stages of data processing:
• Inertial sensors data for a stop detection;
• Inertial sensor data for position, velocity, and heading computations (DR computations);
• Calibration of the inertial sensors when a vehicle is stationary; and
• Integrated GPS/DR navigation solution. The hardware parts of our navigation system are the shaded boxes.
To evaluate the performance of the proposed GPS/DR navigation system, a real-time prototype was built (fig. 2); a yaw-rate gyro (Analog Devices ADXRS150 ) and a 3D accelerometer(VTI Technologies SCA3000 ) were selected as the dead reckoning sensors to augment an L1 GPS receiver (Fastrax IT03 , which is based on chipset by Atheros).
GPS and inertial sensors data fusion
The real time data fusion algorithm employs an extended Kalman filter (EKF) to combine computed GPS position, velocity, and heading with the acceleration and heading rate measurements provided by the 3D accelerometer and heading gyro. The EKF uses the values of the filter states to predict the future states through a dynamic model which is based on dead reckoning equations to estimate position, velocity, and heading. The dynamic model is given by
acceleration in the longitudinal direction. The vehicle frame longitudinal acceleration is calculated by transforming three dimensional acceleration vector measured by accelerometers in the sensor frame into vehicle frame and calculating projection of the transformed vector on vehicle’s longitudinal axes. It also includes the effect of gravitational forces due to unknown road grade. The measured acceleration in longitudinal direction is defined by
In order to model accelerometer and gyro measurement errors and unknown road grade properly, the state vector x is augmented with two additional states: δω gyro bias, and δa acceleration bias and misalignment (including unknown road grade). The augmented state vector is
The states for the gyroscope and acceleration measurement errors were modeled as the first order Gauss-Markov processes. The observation vector is calculated by taking the difference between GPS and DR corresponding positions and velocities, and in some cases heading.
Alignment and calibration
In order to assist GPS with the gyro and accelerometers, initialization procedures have to be completed: initial alignment and calibration. The initial alignment procedure includes horizontal alignment based on the accelerometers outputs, yaw angle estimation using horizontal components of vehicle velocity, and azimuth alignment using external heading information. The initial calibration includes estimation of the accelerometer bias and misalignment, and also calibration of the gyroscope bias.
The horizontal alignment includes the estimation of the sensor frame orientation with respect to the pseudo vehicle frame . The pseudo vehicle frame can be defined as follows: X axis corresponds to longitudinal axis of vehicle, Z axis corresponds to vertical axis of the local level, and Y axis completes the triad. When the vehicle is stationary, the outputs from the horizontal accelerometers are caused by the tilt of the sensor frame with respect to the local horizon and accelerometer biases. This effect can be compensated in the following manner:
In reality, the alignment is usually performed in a place, which is tilted with respect to the local horizon by some small angle. In this case, the transformation matrix will include this misalignment error, which in turn will result in errors when calculating the projection of the acceleration vector on vehicle’s longitudinal axes. However, this misalignment error can be estimated quite accurately when the velocity computed by DR is compared with the GPS velocity. Therefore, the detrimental effect of misalignment error can be reduced when the vehicle’s longitudinal acceleration is compensated with the estimated misalignment error.
The yaw angle between sensor frame and vehicle frame can be estimated when vehicle is accelerating with constant direction  using the following kinematic relation:
In our navigation system, both the alignment and calibration are implemented in real-time and can be performed at any time when vehicle is stationary. It takes about 20 seconds to complete all these procedures in fully automatic mode. There is no need for the user to take any special actions. During and after the alignment the portable navigation device has to be fixed into a cradle.
The system has the capability to reinitialize alignment and calibration parameters at any time when it is not moving. The need for re-computation of alignment parameters may arise due to change in orientation of the device while on the move but the algorithm can detect such a change. This change can affect the gyro scale factor. The need for re-computation of accelerometer and gyro calibration parameters is caused by changes of accelerometer and gyro bias mainly due to temperature variations.
Stop detection module
The stationary state is detected by a stop detection module based on accelerometer information. Our stop detection algorithm is based on the analysis of the vehicle acceleration measured by the accelerometers and its variance. When GPS signals are available the velocity computed by a GPS receiver can also be used.
A typical example of the magnitude of measured acceleration vector during a test drive is shown in Fig. 3. Vehicle acceleration in horizontal plane depends significantly on the movement of the vehicle including road imperfections, measurement bias, and noise. As it can be seen from the curve, during a complete stop the variance of the signal is noticeably smaller since it contains only the gravitational acceleration, accelerometer noise, and engine vibrations. The short time bias drift is negligible. The sampling frequency of accelerometer in this example was 100 Hz.
The real-time implementation of this algorithm is based on the analysis of accelerometer data inside time window of predefined length. The time window length is one of the design parameters in this algorithm and usually chosen as 0.6–1.0 sec. Then the mean quadratic deviation of the acceleration samples from inside this time window is calculated as
Pages: 1 2