Advertisement

Journal of Intelligent & Robotic Systems

, Volume 88, Issue 1, pp 129–146 | Cite as

Clothoids Composition Method for Smooth Path Generation of Car-Like Vehicle Navigation

  • Suhyeon Gim
  • Lounis Adouane
  • Sukhan Lee
  • Jean-Pierre Dérutin
Article

Abstract

This paper addresses a continuous curvature path generation problem for car-like vehicle navigation. The continuous curvature path is generated by multiple clothoids composition and parametric adjustment. According to the geometric conditions of the given initial and final configurations, the path generation problem is classified into two cases and then, each problem is solved by by appropriate proposed algorithm. The solution is obtained by iterative procedure subject to geometric constraint as well as solution constraints. For computational efficiency and fast convergence in the proposed algorithms, a minimax sharpness constraint is proposed as the solution constraint by minimizing the maximum sharpness of the feasible solutions. After the generation of the proposed path, the resultant curvature/sharpness diagram provides a useful information about its orientation and curvature continuity along the travel length. The proposed path planning strategy, permits us to obtain online, smooth and safe path between two defined configurations while ensuring high passengers comfort (continuous curvature and transition between the different composed clothoids). The algorithmic proposals have been applied to generate continuous curvature for two cases. The first correspond to local path planning for ensuring obstacle avoidance or lane change. The second application corresponds to global path smoothing. The resultant global path path is tested on the Lyapunov-based control scheme and showed improved performance on its steering work (reduction of 41.0% than the driving based on the raw data), which permits us therefore to validate the effectiveness of the obtained global path for car-like vehicles path following.

Keywords

Continuous curvature path planning Iterative algorithm Minimax sharpness constraint Nonholonomic car-like vehicle Curvature and sharpness diagram 

Preview

Unable to display preview. Download preview PDF.

Unable to display preview. Download preview PDF.

Notes

Acknowledgments

This research was supported, in part, by the Space R&D Program of National Research Foundation (NRF), NRF-2013M1A3A3A02042335, sponsored by the Korean Ministry of Science, ICT and Planning (MSIP), in part, by the Fundamental Research Program of Korea Evaluation Institute of Industrial Technology (KEIT), 2015-10060160, sponsored by the Korean Ministry of Trade, Industry and Energy (MOTIE).

This research was also funded by the French National Research Agency (ANR) through the support of LabEx IMobS3 (ANR-7107-LABX-716701). The authors deeply appreciate to Prof. Doran K. Wilde for his proof reading and very helpful suggestions.

References

  1. 1.
    Solea, R., Nunes, U.: Trajectory planning with velocity planner for fully-automated passenger vehicle. Intel. Transp. Syst. Conf. 474–480 (2006)Google Scholar
  2. 2.
    Villagra, J., Milantes, V., Perez, J., Godoy, J.: Smooth path and speed planning for an automated public transport vehicle. Robot. Auton. Syst. 60, 252–265 (2012). doi: 10.1016/j.robot.2011.11.001 CrossRefGoogle Scholar
  3. 3.
    Macek, K., Philippsen, R., Siegwart, R.: Path following for autonomous vehicle navigation based on kinodynamic control. J. Comput. Inf. Technol. 17, 17–26 (2009)CrossRefGoogle Scholar
  4. 4.
    Elfes, A.: Occupancy Grids: a probabilistic framework for robot perception and navigation. PhD thesis, Department of Electrical and Computer Engineering, Carneigie Mellon University (1989)Google Scholar
  5. 5.
    Khatib, O.: Real-time obstacle avoidance for manipulators and mobile robots. Int. J. Robot. Res. 5(1), 90–98 (1986)CrossRefGoogle Scholar
  6. 6.
    Kelly, A., Nagy, B.: Reactive nonholonomic trajectory generation via parametric optimal control. Int. J. Robot. Res. 22(7–8), 583–601 (2003)CrossRefGoogle Scholar
  7. 7.
    Likhachev, M., Ferguson, D.: Planning long dynamically feasible maneuvers for autonomous vehicles. Int. J. Robot. Res. 28(8), 933–945 (2009)CrossRefGoogle Scholar
  8. 8.
    Vilca, J., Adouane, L., Mezouar, Y.: Reactive navigation of mobile robot using elliptic trajectories and effective on-line obstacle detection. Gyroscopy and Navigation 4(1), 14–25 (2013). Springer Verlag, Russia ISSN 2075 1087CrossRefGoogle Scholar
  9. 9.
    Chakravarthy, A., Ghose, D.: Obstacle avoidance in a dynamic environment: A collision cone approach. IEEE Trans. Syst. Man Cybern. Syst. Hum. 28(5), 562–574 (1998)CrossRefGoogle Scholar
  10. 10.
    Fulgenzi, C., Spalanzani, A., Laugier, C.: Dynamic obstacle avoidance in uncertain environment combining pvos and occupancy grid. IEEE Int. Conf. Robot. Autom. 1610–1616 (2007)Google Scholar
  11. 11.
    Adouane, L.: Reactive versus cognitive vehicle navigation based on optimal local and global pelc*. Robot. Auton. Syst. 88, 51–70 (2017)CrossRefGoogle Scholar
  12. 12.
    Yang, K., Jung, D., Sukkarieh, S.: Continuous curvature path-smoothing algorithm using cubic bezier spiral curves for non-holonomic robots. Adv. Robot. 27(4), 247–258 (2013)CrossRefGoogle Scholar
  13. 13.
    Lamiraux, F., Laumond, J.P.: Smooth motion planning for car-like vehicles. IEEE Trans. Robot. Autom. 17(4), 498–501 (2001)CrossRefGoogle Scholar
  14. 14.
    Montes, N., Mora, M.C., Tornero, J.: Trajectory generation based on rational Bezier curves as clothoids. IEEE Intel. Vehicles Symposium 505–510 (2007)Google Scholar
  15. 15.
    Avanzini, P., Thuilot, B., Martinet, P.: Manual convoying of automated urban vehicles relying on monocular vision. Int. Vehicles Symposium 19–24 (2012)Google Scholar
  16. 16.
    Dubins, L.E.: On curves of minimal length with a constraint on average curvature, and with prescribed initial and terminal positions and tangents. Am. J. Math. 79, 497– 516 (1957)MathSciNetCrossRefzbMATHGoogle Scholar
  17. 17.
    Reeds, J.A., Shepp, L.A.: Optimal paths for a car that goes both forwards and backwards. Pac. J. Math. 145(2), 367–393 (1990)MathSciNetCrossRefGoogle Scholar
  18. 18.
    Labakhua, L., Nunes, U., Rodrigues, R., Leite, F.S.: Smooth trajectory planning for fully automated passengers vehicles: spline and clothoid based methods and its simulation. In: A.C. et al. (ed.) Informatics in Control Automation and Robotics, Volume 15 of Lecture Notes Electrical Engineering, pp. 159–182 (2008). doi: 10.1007/978-3-540-79142-3-14
  19. 19.
    Fraichard, T., Scheuer, A.: From Reeds and Shepp’s to continuous curvature paths. IEEE Trans. Robot. 20, 1025–1035 (2004)CrossRefGoogle Scholar
  20. 20.
    Parlangeli, G., Indiveri, G.: Dubins inspired 2d smooth paths with bounded curvature and curvature derivative. In: Proceedings of the 7th IFAC Symposium on Intelligent Autonomous Vehicles, pp. 252–257 (2010)Google Scholar
  21. 21.
    Walton, D.J., Meek, D.S.: A controlled clothoid spline. Comput. Graph. 29, 353–363 (2005)CrossRefGoogle Scholar
  22. 22.
    Wilde, D.K.: Computing clothoid segments for trajectory generation. IEEE/RSJ International Conference on Intelligence Robots and Systems, pp. 2440–2445 (2009)Google Scholar
  23. 23.
    Canudas, C., Sicliano, B., Bastin, G.: Theory of robot control. Springer, Berlin Heidelberg, ISBN 3-540-76054-7 (1996)Google Scholar
  24. 24.
    DeLuca, A., Oriolo, G., Samson, C.: Feedback control of a nonholonoic car-like robot (Robot Motion Planning and Control). Springer, Berlin Heidelberg (1998)Google Scholar
  25. 25.
    Adouane, L.: An adaptive multi-controller architecture for mobile robot navigation. In: 10th IAS, Intelligent Autonomous Systems, Baden-Baden, Germany, pp. 342–347 (2008)Google Scholar
  26. 26.
    Valipour, M.: Sprinkle and trickle irrigation system design using tapered pipes for pressure loss adjusting. J. Agric. Sci. 4(12), 125–133 (2012)Google Scholar
  27. 27.
    Valipour, M.: Comparison of surface irrigation simmulation models: full hydrodynamic, zero inertia, kinematic wave. J. Agric. Sci. 4(12), 68–74 (2012)Google Scholar
  28. 28.
    Valipour, M., Banilhabib, M.E., Behbahani, S.M.R.: Comparison of the arma, arima, and the autoregressive artificial neural network models in forecasting the monthly inflow of dez dam reservoir. J. Hydrol. 476(7), 433–441 (2013)CrossRefGoogle Scholar
  29. 29.
    Kiusalaas, J.: Numerical methods in engineering with MATLAB. Cambridge University Press UK, Shaftesbury Road, Cambridge CB2 8BS, UK (2007)Google Scholar
  30. 30.
    Chen, J., Zhao, P., Mei, T., Liang, H.: Lane change path planning based on piecewise bezier curve for autonomous vehicle. In: IEEE International Conference on Vehicular Electronics and Safety, pp. 17–22 (2013)Google Scholar
  31. 31.
    Wang, Y., Cartmell, M.P: Trajectory generation for a four wheel steering tractor-trailer system: a two-step method. Robotica 16(4)Google Scholar
  32. 32.
    Vilca, J.M., Adouane, L., Mezouar, Y.: A novel safe and flexible control strategy based on target reaching for the navigation of urban vehicles. Robot. Auton. Syst. 70, 215–226 (2015)CrossRefGoogle Scholar
  33. 33.
    Gim, S., Adouane, L., Lee, S., Derutin, J.P.: Parametric continuous curvature trajectory for smooth steering of the car-like vehicle. In: International Conference on Intelligent Autonomous Systems (2014)Google Scholar

Copyright information

© Springer Science+Business Media Dordrecht 2017

Authors and Affiliations

  1. 1.SungKyunKwan UniversitySuwonKorea
  2. 2.Institut Pascal/IMobS3Université Clermont Auvergne, CNRS, SIGMAClermont-FerrandFrance

Personalised recommendations