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.

[1]  L. Dubins On Curves of Minimal Length with a Constraint on Average Curvature, and with Prescribed Initial and Terminal Positions and Tangents , 1957 .

[2]  Philippe Martinet,et al.  Manual convoying of automated urban vehicles relying on monocular vision , 2012, 2012 IEEE Intelligent Vehicles Symposium.

[3]  L. Shepp,et al.  OPTIMAL PATHS FOR A CAR THAT GOES BOTH FORWARDS AND BACKWARDS , 1990 .

[4]  Tao Mei,et al.  Lane change path planning based on piecewise Bezier curve for autonomous vehicle , 2013, Proceedings of 2013 IEEE International Conference on Vehicular Electronics and Safety.

[5]  Dereck S. Meek,et al.  A controlled clothoid spline , 2005, Comput. Graph..

[6]  Lounis Adouane,et al.  Parametric Continuous Curvature Path for Smooth Steering with Car-like Vehicles , 2014, IAS.

[7]  Alonzo Kelly,et al.  Reactive Nonholonomic Trajectory Generation via Parametric Optimal Control , 2003, Int. J. Robotics Res..

[8]  M. Valipour,et al.  Comparison of the ARMA, ARIMA, and the autoregressive artificial neural network models in forecasting the monthly inflow of Dez dam reservoir , 2013 .

[9]  Rui Rodrigues,et al.  Smooth trajectory planning for fully automated passengers vehicles - spline and clothoid based methods and its simulation , 2006, ICINCO-RA.

[10]  M. Valipour Comparison of Surface Irrigation Simulation Models: Full Hydrodynamic, Zero Inertia, Kinematic Wave , 2012 .

[11]  N. Montés,et al.  Trajectory Generation based on Rational Bezier Curves as Clothoids , 2007, 2007 IEEE Intelligent Vehicles Symposium.

[12]  Alberto Elfes,et al.  Occupancy grids: a probabilistic framework for robot perception and navigation , 1989 .

[13]  Giuseppe Oriolo,et al.  Feedback control of a nonholonomic car-like robot , 1998 .

[14]  Lounis Adouane,et al.  A novel safe and flexible control strategy based on target reaching for the navigation of urban vehicles , 2015, Robotics Auton. Syst..

[15]  Yongji Wang,et al.  Trajectory generation for a four wheel steering tractor-trailer system: a two-step method , 1998, Robotica.

[16]  Lounis Adouane,et al.  Reactive versus cognitive vehicle navigation based on optimal local and global PELC∗ , 2017, Robotics Auton. Syst..

[17]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1986 .

[18]  Roland Siegwart,et al.  Path Following for Autonomous Vehicle Navigation Based on Kinodynamic Control , 2009, J. Comput. Inf. Technol..

[19]  Christian Laugier,et al.  Dynamic Obstacle Avoidance in uncertain environment combining PVOs and Occupancy Grid , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[20]  Lounis Adouane,et al.  Reactive navigation of a mobile robot using elliptic trajectories and effective online obstacle detection , 2013 .

[21]  Vicente Milanés Montero,et al.  Smooth path and speed planning for an automated public transport vehicle , 2012, Robotics Auton. Syst..

[22]  Maxim Likhachev,et al.  Planning Long Dynamically Feasible Maneuvers for Autonomous Vehicles , 2008, Int. J. Robotics Res..

[23]  Lounis Adouane An Adaptive Multi-Controller Architecture for Mobile Robot Navigation , 2008 .

[24]  Jaan Kiusalaas,et al.  Numerical Methods in Engineering with MATLAB®: Index , 2005 .

[25]  Salah Sukkarieh,et al.  Continuous curvature path-smoothing algorithm using cubic B zier spiral curves for non-holonomic robots , 2013, Adv. Robotics.

[26]  Thierry Fraichard,et al.  From Reeds and Shepp's to continuous-curvature paths , 1999, IEEE Transactions on Robotics.

[27]  Gianfranco Parlangeli,et al.  Dubins inspired 2D smooth paths with bounded curvature and curvature derivative. , 2010 .

[28]  Mohammad Valipour,et al.  Sprinkle and Trickle Irrigation System Design Using Tapered Pipes for Pressure Loss Adjusting , 2012 .

[29]  Florent Lamiraux,et al.  Smooth motion planning for car-like vehicles , 2001, IEEE Trans. Robotics Autom..

[30]  Carlos Canudas de Wit,et al.  Theory of Robot Control , 1996 .

[31]  Debasish Ghose,et al.  Obstacle avoidance in a dynamic environment: a collision cone approach , 1998, IEEE Trans. Syst. Man Cybern. Part A.

[32]  Urbano Nunes,et al.  Trajectory Planning with Velocity Planner for Fully-Automated Passenger Vehicles , 2006, 2006 IEEE Intelligent Transportation Systems Conference.

[33]  Doran Wilde Computing clothoid segments for trajectory generation , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.