Clothoids Composition Method for Smooth Path Generation of Car-Like Vehicle Navigation
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.
KeywordsContinuous curvature path planning Iterative algorithm Minimax sharpness constraint Nonholonomic car-like vehicle Curvature and sharpness diagram
Unable to display preview. Download preview PDF.
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.
- 1.Solea, R., Nunes, U.: Trajectory planning with velocity planner for fully-automated passenger vehicle. Intel. Transp. Syst. Conf. 474–480 (2006)Google Scholar
- 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
- 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
- 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.Avanzini, P., Thuilot, B., Martinet, P.: Manual convoying of automated urban vehicles relying on monocular vision. Int. Vehicles Symposium 19–24 (2012)Google Scholar
- 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
- 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
- 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.Canudas, C., Sicliano, B., Bastin, G.: Theory of robot control. Springer, Berlin Heidelberg, ISBN 3-540-76054-7 (1996)Google Scholar
- 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.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.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.Valipour, M.: Comparison of surface irrigation simmulation models: full hydrodynamic, zero inertia, kinematic wave. J. Agric. Sci. 4(12), 68–74 (2012)Google Scholar
- 29.Kiusalaas, J.: Numerical methods in engineering with MATLAB. Cambridge University Press UK, Shaftesbury Road, Cambridge CB2 8BS, UK (2007)Google Scholar
- 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.Wang, Y., Cartmell, M.P: Trajectory generation for a four wheel steering tractor-trailer system: a two-step method. Robotica 16(4)Google Scholar
- 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