On the G2 Hermite Interpolation Problem with clothoids

Abstract The G 2 Hermite Interpolation Problem with clothoid curves requires to find the interpolating clothoid that matches initial and final positions, tangents and curvatures, also known as G 2 Hermite data. In the paper we prove that this problem does not always admit solution with only one clothoid segment, nor with two, as some counterexamples show. The general fitting scheme herein proposed requires three arcs determined via the solution of a nonlinear system of 8 equations in 10 unknowns. We discuss how it is possible to recast this system to 2 equations and how to efficiently solve it by means of the Newton method. The choice of the clothoid is crucial because it exhibits the curvature which is linear with the arc length, an important property in many applications ranging from path planning for autonomous vehicles, road design, manufacturing and graphics. The algorithm is tested on a fine hypercube of all possible configurations of angles and curvatures. It always converges and in the worst case it requires 5 standard Newton iterations.

[1]  Dereck S. Meek,et al.  An involute spiral that matches G2 Hermite data in the plane , 2009, Comput. Aided Geom. Des..

[2]  Dereck S. Meek,et al.  A note on finding clothoids , 2004 .

[3]  Karan Singh,et al.  Sketching piecewise clothoid curves , 2008, SBM'08.

[4]  Josef Stoer,et al.  Curve Fitting With Clothoidal Splines. , 1982, Journal of research of the National Bureau of Standards.

[5]  Dereck S. Meek,et al.  Planar G 2 Hermite interpolation with some fair, C-shaped curves , 2002 .

[6]  M. Abramowitz,et al.  Handbook of Mathematical Functions With Formulas, Graphs and Mathematical Tables (National Bureau of Standards Applied Mathematics Series No. 55) , 1965 .

[7]  Enrico Bertolazzi,et al.  Semianalytical minimum-time solution for the optimal control of a vehicle subject to limited acceleration: Semi-Analytical Minimum Time Solution , 2018 .

[8]  D. Walton,et al.  G 1 interpolation with a single Cornu spiral segment , 2008 .

[9]  Lilia Krivodonova,et al.  Interpolation of two-dimensional curves with Euler spirals , 2014, J. Comput. Appl. Math..

[10]  D. Walton,et al.  Clothoid spline transition spirals , 1992 .

[11]  E. Bertolazzi,et al.  Interpolating clothoid splines with curvature continuity , 2018 .

[12]  Daniele Fontanelli,et al.  Walking Ahead: The Headed Social Force Model , 2017, PloS one.

[13]  Thor I. Fossen,et al.  Continuous-Curvature Path Generation using Fermat's Spiral , 2013 .

[14]  V A Profillidis,et al.  Railway Management and Engineering: Fourth Edition , 2016 .

[15]  Luigi Palopoli,et al.  Path planning maximising human comfort for assistive robots , 2016, 2016 IEEE Conference on Control Applications (CCA).

[16]  E. Bertolazzi,et al.  G1 fitting with clothoids , 2015 .

[17]  Zulfiqar Habib,et al.  G2 cubic transition between two circles with shape control , 2009 .

[18]  Luigi Palopoli,et al.  Semi-analytical minimum time solutions with velocity constraints for trajectory following of vehicles , 2017, Autom..

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

[20]  Jean-Paul Laumond,et al.  On the nonholonomic nature of human locomotion , 2008, Auton. Robots.

[21]  Jean-Paul Laumond,et al.  An Optimality Principle Governing Human Walking , 2008, IEEE Transactions on Robotics.

[22]  Luigi Palopoli,et al.  Reactive Planning for Assistive Robots , 2018, IEEE Robotics and Automation Letters.

[23]  G S Kassab,et al.  3D reconstruction of elastin fibres in coronary adventitia , 2017, Journal of microscopy.

[24]  Dereck S. Meek,et al.  Planar spirals that match G2 Hermite data , 1998, Comput. Aided Geom. Des..

[25]  Robert J. Cripps,et al.  Efficient robust approximation of the generalised Cornu spiral , 2015, J. Comput. Appl. Math..

[26]  Ángel F. García-Fernández,et al.  Long-Range Road Geometry Estimation Using Moving Vehicles and Roadside Observations , 2016, IEEE Transactions on Intelligent Transportation Systems.

[27]  Weiyin Ma,et al.  Matching admissible G2 Hermite data by a biarc-based subdivision scheme , 2012, Comput. Aided Geom. Des..

[28]  Thierry Fraichard,et al.  Continuous-curvature path planning for car-like vehicles , 1997, Proceedings of the 1997 IEEE/RSJ International Conference on Intelligent Robot and Systems. Innovative Robotics for Real-World Applications. IROS '97.