Keywords |
| Extended Kalman Filter, In-vehicle Sensors, Vehicle Positioning and Vehicle Model Set. |
INTRODUCTION |
| Today the importance of real time vehicle positioning is more than that in the earlier time. Intelligent transportation system (ITS) is one of the important areas where real time vehicle positioning is used. Normally, the satellite-based global position system (GPS) is widely used for positioning the vehicle. But these GPS receivers cannot give accurate information about the positioning of the vehicle due to the temporary or occasional loss of satellite connection and signal errors. To overcome these problems the positioning system should be aided by additional sensors such as inertial navigation system (INS), digital road map, camera, radar or laser sensor, vehicle motion sensors, etc [1]. The previous works will motivate to develop an algorithm for real time vehicle positioning on failure of GPS, which should overcome the entire problem affected in the previous works and that algorithm should give reliable, accurate and continuous data. In the proposed system, the data from in-vehicle sensors such as wheel speed sensors, a yaw rate sensor and a steering angle sensor with GPS data are fused by the help of Extended Kalman filter (EKF). To fuse these data, the algorithm needs good filters. For that numerous Bayesian filters based sensor fusion approaches have been proposed [13]. The extended Kalman filter (EKF) is the most widely used filter for information fusion algorithms because nonlinear localization problems can easily be solved which provides efficient and reliable performance for practical applications. |
| In this work, an algorithm would be developed, which combines the data from in-vehicle sensors such as wheel speed sensors, yaw rate sensor and steering angle sensor with GPS data. So this algorithm gives a more accurate, continuous and reliable outcome to positioning the vehicle. In this work EKF is used for the fusion of in-vehicle sensor data with GPS data. Another important thing is the analysis of different driving conditions of the vehicle. Depending on the driving conditions, the data from in-vehicle sensors will change and the occurrence of error will be more. So the algorithm should have suitable vehicle model set for different driving conditions. In this work, two-vehicle models would be developed, kinematic and dynamic vehicle model. The kinematic model is suitable for low speed and low slip driving condition such as those in an intersection or parking lot. Dynamic model is suitable under high speed and large slip driving conditions such as those in highway driving. These two models are developed using EKF. Kinematic model is based on the assumption of small wheel slip condition, but in dynamic model tire slip and lateral force are considered. The selection of these models during real time is a challenging process. This approach describes that the system selects one of the models from a finite number of different model based on the speed range of the vehicle. |
LITERATURE SURVEY |
| 许多算法pa的进化st few decades to achieve real time vehicle positioning. Fusion of GPS data with vehicle sensors data is the common solution to improve the vehicle positioning. In previous works, additional sensors such as an inertial navigation system (INS), vehicle motion sensors, radar or laser sensor, etc. were used along with GPS receiver. The fusion of GPS data with INS is normally done in previous algorithms, where the problem is the installation of an INS requires extra cost and effort; also accurate INS systems are too expensive for automotive application. To tackle the problem associated with GPS, several approaches have been proposed. Combined use of GPS and an inertial measurement unit (IMU) unit is one solution [1], [2], [3]. The main problem in this algorithm is the errors caused by bias in the sensor readings and inaccurate readings which will cause error in the local navigation frame. Another solution is combined use of GPS and MEMS (Micro Electro Mechanical System) inertial sensor [4], [5]. The basic advantages of this method are precise and much faster reaction but the performance of the system would be affected by external factors. Use of Differential GPS is another solution [6]. It will avoid the errors occur due to the synchronization problem. But it does not guarantee correct data at every time. Kalman filter based integration of DGPS and vehicle sensors is another algorithm developed in this area, but this algorithm works only in a linear system, not in a nonlinear system [7], [8], [9]. And another one valid algorithm is the fusion of GPS data with vehicle motion sensor data using particle [10]. This algorithm gives more accurate and correct data to the positioning system, but one problem in this method requires excessive computational power. The other suitable work in this area is the fusion of GPS with INS using interacting multiple model filter algorithms [11], [12]. The only problem is that, INS system is too expensive. |
 |
| The above fig.1 describes the overall system overview the proposed work. The proposed algorithms combine the data from in-vehicle sensors with GPS receiver and provide reliable and continuous position information. Proposed system is classified into two parts, a sensor part and a position algorithm part. The sensor part is composed of a group of invehicle sensors and a low-cost GPS receiver. The positioning algorithm part composed of two different model, kinematic model and dynamic model. These two models indicate the vehicle in different driving condition. In the proposed system, the positioning algorithm that estimates the vehicle position by combining data from in-vehicle sensors with GPS receiver data. This algorithm is the combination of Extended Kalman Filters. EKF is used as information fusion algorithm and predicts the next state with respect to the current state. The basic advantage of EKF is that it will avoid the nonlinear localization problem. Then based on the vehicle speed any one of the vehicle models will be selected. Normally, kinematic vehicle model is suitable in low speed and small tire slip condition, and dynamic model is suitable for high speed and large tire slip condition. So at high speed dynamic model should be selected and similarly at low speed kinematic model is selected. |
VEHICLE MODEL SET |
| 车辆运动应该在本质上是动态的开掘ding upon the road condition, traffic, environment, etc. This dynamic change of vehicle movement also changes the motion parameter related to the vehicle such as velocity, heading angle, lateral force acting on the tires, vehicle slip, etc. [16]. So to develop a suitable algorithm to overcome these errors, we should be design and select a suitable vehicle model. In this work, the kinematic and dynamic models are used to represent a possible type of vehicle motion. Basic parameter considered in these vehicle models are tire slip and lateral force. |
| Kinematic Vehicle Model |
 |
| The kinematic vehicle model represents the vehicle motion parameter when the vehicle moves in slow speed. That is, the tire slip does not exist between the road and tires. Example if the vehicle is in traffic situation or in a parking lot. The fig.2 represents the kinematic model developed by using the fundamental bicycle model [13]. In this model, the pair of front and rear wheels of the vehicle should be considered as a single wheel. G is the centre of gravity of the vehicle. The distance from G to front and rear wheel are represented as Fl and Rl. The point O is the instantaneous rotation centre. The co-ordinate X and Y represents the location of G in the global frame. The angle δ, Ψ and β represent the front steering angle, heading angle and vehicle slip angle respectively. The velocity at point F, G and R areVf , Vg and Vr respectively. |
| Kinematic model does not consider tire slip between wheels and the ground for vehicular positioning. By using the above kinematics model, the parameter required for the calculation of vehicular position can be derived. The derivation should be explained below, |
| Consider triangle OFG and ORG, by applying the sine rule to both following equations can be obtained: |
 |
 |
| By rearranging (1) and (2) |
 |
 |
| Add (3) and (4) |
 |
| 如果车辆路径的半径Gr缓慢变化s due to low vehicle speed than the rate of change of orientation of the vehicle should be equal to the angular velocity of the vehicle γ as follows: |
 |
| Substitute (5) in (6) |
 |
| The vehicle slip angle β can be calculated by dividing (3) by (4) as |
 |
| The global motion of the vehicle can be represented in terms of vehicle velocity VG and course angle ψ + β, |
 |
 |
| 动态车辆模型 |
 |
| 动态车辆模型represents the vehicle motion parameter when the vehicle moves into high speed. The tire slip and lateral force are two factors that will affect the motion of the vehicle during high speed. So these two parameters are also considered during the development of the dynamic model [17]. The figure.4 represents the dynamic model of the vehicle developed by using the fundamental bicycle model [13]. Similar to kinematic model, all the variables represent the same in addition α represent tire slip angle and Fyf and Fyr represent lateral force acting on front and rear wheels respectively. |
| The dynamic vehicle model assumes that the lateral force acting on a tire is proportional to the tire slip angle. The tire slip angle can be defined as the angle of the wheel velocity vector relative to the longitudinal wheel axis, |
 |
 |
| We can calculate the overall vehicle motion of the dynamic vehicle model using the following equation: |
 |
 |
 |
 |
 |
EXTENDED KALMAN FILTER |
| The proposed positioning algorithm is based on the working of extended Kalman filter. Here two type of vehicle model set are used. These two models are developed by using EKF. Under high speed and high slip driving conditions, the dynamic model based filter is used because it considers lateral force and tire slip. Similarly, under low speed and low slip driving conditions, the kinematic model based filter is used because the slip angle of the tire is very small. Extended Kalman filter has proven to be a useful method of obtaining good estimates of the system state [15]. It consists of two steps, prediction step and update step. In predict step, the state and covariance matrix of the previous state are predicted. And in the update step, update the predicted state and covariance matrix. The predict and update equations of EKF are give below [14], |
 |
| Using the above equations we can develop kinematic and dynamic vehicle model after that introduce these models in to the proposed algorithm. The algorithm will select one of the models from these models based on the current speed of the vehicle. |
SIMULATION AND RESULT |
| 该算法通过定向断裂进行了分析ive simulation and results of simulation are plotted as graphs. The simulation was performed using MATLAB software and Simulink package is used to analyse the algorithm. The kinematic and dynamic vehicle models are developed by using user defined blocks in Simulink where the inputs given to the blocks are velocity, steering angle, yaw rate and position. The outputs from the blocks are plotted in XY plot. The results are given below, |
 |
| Fig.4 shows the Simulink model of kinematic vehicle model and its output plot based on the inputs. The inputs given to the models are velocity, steering angle, yaw rate and position. The kinematic model is suitable only when the vehicle moving at slow speed. If the vehicle is moving at high speed then the model will not predict accurate position and output contain more error. The inputs to this Simulink model, typically velocity are given as gradually increasing manner. So in high velocity, the graph plotted using the kinematic model is inaccurate that we can see inside Fig.4. |
 |
| The dynamic vehicle model is similar expect the inclusion of the parameters, tire slip and lateral force which is depicted in fig.5. The figure shows the Simulink model of dynamic vehicle model and its output plot based on the inputs. The dynamic model is suitable only when the vehicle moving at high speed. If the vehicle is moving at slow speed then the model will not predict accurate position and output contain more error. The inputs to this Simulink model, typically velocity are given as gradually increasing manner. So in low velocity, the graph plotted using the dynamic model is inaccurate that we can see inside Fig.5. |
 |
| Finally, fig.6 shows the proposed model which encapsulated both kinematic and dynamic model where the velocity of the vehicle acts as the condition for selecting the model to be performed. The inputs to this Simulink model, typically velocity are given as gradually increasing manner. So based on the velocity of the vehicle the proposed system will select a suitable model. If the vehicle is moving at slow speed then the proposed system select kinematic model and the vehicle is moving at high speed then the proposed system select dynamic model. The output of the proposed model found to be more precise when compared to the output shown in fig.4 and fig.5. |
CONCLUSION |
| An algorithm for real time vehicle positioning system is successfully simulated which incorporates both kinematic and dynamic vehicle model using EKF. The platform used for simulating the algorithm is Simulink which is an additional package of MATLAB software. The simulation result showed that the estimates of the developed algorithm were accurate and reliable under the various driving conditions. Due to the limitations of the two degree of freedom, the estimation of vehicle position in a very sharp sloped driving environment and large longitudinal tire slip condition was prohibited. As an extension of this work, stochastic algorithms can be integrated, which helps to improve the accuracy in the outcome of the system. |
References |
- S. Sukkarieh, E. M. Nebot, and H. F. Durrant-Whyte, “A high integrity IMU/GPS navigation loop for autonomous land vehicle applications,” IEEE Trans. Robot.Autom., vol. 15, no. 3, pp. 572–578, Jun. 1999.
- G. Dissanayake, S. Sukkarieh, E. Nebot, and H. Durrant-Whyte, “The aiding of a low-cost strapdown inertial measurement unit using vehicle model constraints for land vehicle applications,” IEEE Trans. Robot. Autom., vol. 17, no. 5, pp. 731–747, Oct. 2001.
- S. Panzieri, F. Pascucci, and G. Ulivi, “An outdoor navigation system using GPS and inertial platform,” IEEE/ASME Trans. Mechatronics, vol. 7, no. 2, pp. 134–142, Jun. 2002.
- G. Fiengo, D. Di Domenico, and L. Glielmo, “A hybrid procedure strategy for vehicle localization system: Design and prototyping,” Control Eng. Pract., vol. 17, no. 1, pp. 14–25, Jan. 2009.
- R. Dixon and J. Bouchaud, “Prospects for MEMS in the automotive industry,” Sens. Transducers J., vol. 86, no. 12, pp. 1778–1784, Dec. 2007.
- J. Huang and H. S. Tan, “A low-order DGPS-based vehicle positioning system under urban environment,” IEEE/ASME Trans. Mechatronics, vol. 11, no. 5, pp. 567–575, Oct. 2006.
- S. Rezaei and R. Sengupta, “Kalman filter-based integration of DGPS and vehicle sensors for localization,” IEEE Trans. Control Syst. Technol., vol. 15, no. 6, pp. 1080–1088, Nov. 2007.
- H. Qi and J. B. Moore, “Direct Kalman filtering approach for GPS/INS integration,” IEEE Trans. Aerosp.Electron. Syst., vol. 38, no. 2, pp. 687– 693, Apr. 2002.
- e . f . Caron duflo, d .波莫人rski, and P. Vanheeghe, “GPS/IMU data fusion using multisensorKalman filtering: Introduction of contextual aspects,” Inf. Fusion, vol. 7, no. 2, pp. 221–230, Jun. 2006.
- Y. Cui and S. S. Ge, “Autonomous vehicle positioning with GPS in urban canyon environments,” IEEE Trans. Robot.Autom., vol. 19, no. 1, pp. 15– 25, Feb. 2003.
- R. Toledo-Moreo and M. A. Zamora-Izquierdo, “IMM-based lane-change prediction in highways with low-cost GPS/INS,” IEEE Trans. Intell. Transp. Syst., vol. 10, no. 1, pp. 180–185, Mar. 2009.
- D. Huang and H. Leung, “EM-IMM based land-vehicle navigation with GPS/INS,” in Proc. IEEE ITSC, Washington, DC, 2004, pp. 624–629.
- KichunJo,Keounyup Chu and MyounghoSunwoo, “Interacting Multiple Model Filter- Based Sensor Fusion of GPS With In-Vehicle Sensors for Real-Time Vehicle Positioning” in IEEE Trans. Intell. Transp. Syst., vol. 13, no. 1, Mar. 2012.
- S. S. Haykin (Ed.) Kalman filtering and neural networks (pp. 123-174). New York: Wiley. 2001.
- C. Barrios, H. Himberg, Y. Motai, and A. Sadek, “Multiple model frame- work of adaptive extended Kalman filtering for predicting vehicle loca- tion,” in Proc. IEEE ITSC, Toronto, ON, Canada, 2006, pp. 1053–1059.
- R. Rajamani, Vehicle Dynamics and Control. New York: Springer- Verlag, 2006.
- M. Tanelli, L. Piroddi, and S. M. Savaresi, “Real-time identification of tire-road friction conditions,” IET Control Theory Appl., vol. 3, no. 7, pp. 891–906, Jul. 2009.
|
Menu
