Optimal sensor fusion and position control of a low-price self-driving vehicle in short-term operation conditions

  • Jungsu Choi
  • Kyoungchul Kong
Regular Papers Robot and Applications


Real-time estimation of the absolute position and orientation plays a critical role in the control and path planning of a self-driving vehicle. Global positioning systems (GPSs) are used to estimate the absolute position of a vehicle from satellite signals, but their reliability and accuracy are not sufficient for precise control. An inertial navigation system (INS) is often used to complement the GPS, but it is always subjected to a drift problem due to integration. Such a problem has been solved by utilizing a high performance GPS, an INS, a vision sensor, a radar, a laser scanner, or their combination. However, these sensor systems are very expensive compared to the price of common commercial vehicles, which hinders the popularization of self-driving vehicles. Moreover, the target users of self-driving vehicles are most likely the elderly, as well as the blind, and thus the price is an important factor in the system design. In this paper, a sensor fusion method for a low-price self-driving vehicle and real-time path planning algorithm without a laser scanner are introduced. The proposed low-price sensor system consists of a GPS, an inertial measurement unit (IMU) with a three-axes accelerometer, a three-axes gyroscope, and a three-axes magnetometer, an encoder at the real wheels, and a potentiometer that measures the steering angle. The overall price is less than 300 USD. For the complete estimation of the absolute position and orientation of the vehicle, the proposed method estimates the driving velocity using a kinematic Kalman filter, then the orientation angle and absolute position are calculated by the recursive least squares method. The obtained information is then used for the real-time control of a self-driving vehicle. The proposed method is verified through simulation studies and by experimental results.


Extended Kalman filter motion sensors self-driving vehicle sensor fusion 


Unable to display preview. Download preview PDF.

Unable to display preview. Download preview PDF.


  1. [1]
    F. U. Syed, M. L. Kuang, M. Smith, S. Okubo, and H. Ying, “Fuzzy gain–scheduling proportional–integral control for improving engine power and speed behavior in a hybrid electric vehicle,” IEEE Trans. on Vehicular Technology, vol. 58, no. 1, pp. 69–84, January 2009. [click]CrossRefGoogle Scholar
  2. [2]
    Wikipedia, “Hybrid electric vehicle,”Google Scholar
  3. [3]
    Toyota, Scholar
  4. [4]
    Honda, Scholar
  5. [5]
    Wikipedia, “Electric vehicle,”Google Scholar
  6. [6]
    Tesla, Scholar
  7. [7]
    I. Fialho and G. J. Balas, “Road adaptive active suspension design using linear parameter–varying gain–scheduling,” IEEE Trans. on Control Systems Technology, vol. 10, no. 1, pp. 43–54, January 2002. [click]CrossRefGoogle Scholar
  8. [8]
    Mercedes–Benz TechCenter: Active Body Control ABC, http://techcenter.mercedes–benz.comGoogle Scholar
  9. [9]
    L. Fletcher, N. Apostoloff, L. Petersson, and Alexander Zelinsky, “Vision in and out of vehicles,” IEEE Intelligent Systems, vol. 18, no. 3, pp. 12–17, June 2003.CrossRefGoogle Scholar
  10. [10]
    National Center for Biotechnology Information, http://www.ncbi.nlm.nih.govGoogle Scholar
  11. [11]
    BMWBLOG, http://www.bmwblog.comGoogle Scholar
  12. [12]
    R. Cabrera–Cósetl, M. Z. Mora–Álvarez, Rubén Alejos–Palomares, “Self–parking system based in a fuzzy logic approach,” Proc. of Electrical, Communication, and Computer, pp. 119–124, 2009.Google Scholar
  13. [13]
    C. G. Keller, T. Dang, H. Fritz, A. Joos, C. Rabe, and D. M. Gavrila, “Active pedestrian safety by automatic braking and evasive steering,” IEEE Trans. on Intelligent Transportation Systems, vol. 12, no. 4, pp. 1292–1304, 2011. [click]CrossRefGoogle Scholar
  14. [14]
    S. Sukkarieh, E. M. Nebot, and H. F. Durrant–Whyte, “A high integrity IMU/GPS navigation loop for autonomous land vehicle applications,” IEEE Robotics and Automation Magazine, vol. 15, no. 3, pp. 572–578, June 1999. [click]CrossRefGoogle Scholar
  15. [15]
    R. Toledo–Moreo, M. A. Zamora–Izquierdo, B. Ubeda–Minarro, and A. F. Gomez–Skarmeta, “High–integrity IMM–EKF–based road vehicle navigation with low–cost GPS/SBAS/INS,” IEEE Trans. on Intelligent Transportation Systems, vol. 8, No. 3, pp. 491–511, September 2007. [click]CrossRefGoogle Scholar
  16. [16]
    S. Hong, M. H. Lee, S. H. Kwon, and H. H. Chun, “A car test for the estimation of GPS/INS alignment errors,” IEEE Trans. on Intelligent Transportation Systems, vol. 5, no. 3, pp. 208–218, September 2011.CrossRefGoogle Scholar
  17. [17]
    O. Eroglu and G. Yilmaz, “A novel fast and accurate algorithm for Terrain Referenced UAV localization,” 2013 Proc. of Unmanned Aircraft Systems, pp. 660–667, 2013.Google Scholar
  18. [18]
    J. Huang, and H. S. Tan, “A low–order DGPS–based vehicle positioning system under urban environment,” IEEE/ASME Trans. on Mechatronics, vol. 11, no. 5, pp. 567–575, October 2006. [click]CrossRefGoogle Scholar
  19. [19]
    W. Li and H. Leung, “Constrained unscented Kalman lter based fusion of GPS/INS/digital map for vehicle localization,” Proc. of Intelligent Transportation Systems, pp. 1362–1367, 2003.Google Scholar
  20. [20]
    K. Jo, K. Chu, and M. Sunwoo, “Interacting multiple model filter–based sensor fusion of GPS with in–vehicle sensors for real–time vehicle positioning,” IEEE Trans. on Intelligent Transportation Systems, vol. 13, no. 1, pp. 329–343, March 2011. [click]CrossRefGoogle Scholar
  21. [21]
    H. Uchiyama, D. Deguchi, T. Takahashi, I. Ide, and H. Murase, “Ego–localization using streetscape image sequences from in–vehicle cameras,” Proc. of Intelligent Vehicles Symposium, pp. 185–190, 2009. [click]Google Scholar
  22. [22]
    R. Toledo–Moreo, D. Betaille, and F. Peyret, “Lane–level integrity provision for navigation and map matching with GNSS, dead reckoning, and enhanced maps,” IEEE Trans. on Intelligent Transportation Systems, vol. 11, no. 1, pp. 100–112, March 2010. [click]CrossRefGoogle Scholar
  23. [23]
    Business Insider, http://www.businessinsider.comGoogle Scholar
  24. [24]
    H. J. Woo, S. B. Park, K. H. Cho, and J.H. Kim, “Research of the Optimal Local and Global Path Planning for Unmanned Ground Vehicle,” KSAE Annual Conference, pp. 988992, 2009.Google Scholar
  25. [25]
    P. E. Hart, N. J. Nilsson, and B. Raphael, “A Formal Basis for the Heuristic Determination of Minimum Cost Paths,” IEEE Trans. on Systems Science and Cybernetics, vol. SSC–4, no. 2, pp. 100107, 1968.Google Scholar

Copyright information

© Institute of Control, Robotics and Systems and The Korean Institute of Electrical Engineers and Springer-Verlag GmbH Germany, part of Springer Nature 2017

Authors and Affiliations

  1. 1.Department of Mechanical EngineeringSogang UniversitySeoulKorea

Personalised recommendations