An Analytical Continuous-Curvature Path-Smoothing Algorithm

An efficient and analytical continuous-curvature path-smoothing algorithm, which fits an ordered sequence of waypoints generated by an obstacle-avoidance path planner, is proposed. The algorithm is based upon parametric cubic Bézier curves; thus, it is inherently closed-form in its expression, and the algorithm only requires the maximum curvature to be defined. The algorithm is, thus, computational efficient and easy to implement. Results show the effectiveness of the analytical algorithm in generating a continuous-curvature path, which satisfies an upper bound-curvature constraint, and that the path generated requires less control effort to track and minimizes control-input variability.

[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]  Richard H. Bartels,et al.  An introduction to the use of splines in computer graphics and geometric modeling , 1986 .

[3]  Kazuo Tanie,et al.  Trajectory Design and Control of a Wheel-type Mobile Robot Using B-spline Curve , 1989, Proceedings. IEEE/RSJ International Workshop on Intelligent Robots and Systems '. (IROS '89) 'The Autonomous Mobile Robots and Its Applications.

[4]  Winston Nelson,et al.  Continuous-curvature paths for autonomous vehicles , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

[5]  John F. Canny,et al.  Planning smooth paths for mobile robots , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

[6]  Michael A. Lachance,et al.  An introduction to splines for use in computer graphics and geometric modeling , 1990 .

[7]  Tony DeRose,et al.  Geometric continuity of parametric curves: constructions of geometrically continuous splines , 1990, IEEE Computer Graphics and Applications.

[8]  Thierry Fraichard.  Smooth trajectory planning for a car in a structured world , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[9]  Jean-Paul Laumond,et al.  Primitives for smoothing mobile robot trajectories , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[10]  Masaru Uchiyama,et al.  Optimal Geometric Structures of Force/Torque Sensors , 1995, Int. J. Robotics Res..

[11]  Jens Gravesen,et al.  Adaptive Subdivision and the Length and Energy of Bézier Curves , 1997, Comput. Geom..

[12]  Jean-Paul Laumond,et al.  Dynamic path modification for car-like nonholonomic mobile robots , 1997, Proceedings of International Conference on Robotics and Automation.

[13]  D. Walton,et al.  Curvature extrema of planar parametric polynomial cubic curves , 2001 .

[14]  Vikram Kapila,et al.  Optimal path planning for unmanned air vehicles with kinematic and tactical constraints , 2002, Proceedings of the 41st IEEE Conference on Decision and Control, 2002..

[15]  Timothy W. McLain,et al.  Coordinated target assignment and intercept for unmanned air vehicles , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[16]  Dong-Soo Kwon,et al.  Mobile robots at your fingertip: Bezier curve on-line trajectory generation for supervisory control , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[17]  Keiji Nagatani,et al.  Sensor-based navigation for car-like mobile robots based on a generalized Voronoi graph , 2003, Adv. Robotics.

[18]  Jun Ota,et al.  Smooth path planning by using visibility graph-like method , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[19]  Dereck S. Meek,et al.  Planar G 2 transition curves composed of cubic Bézier spiral segments , 2003 .

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

[21]  Y. Qu,et al.  Flight path planning of UAV based on heuristically search and genetic algorithms , 2005, 31st Annual Conference of IEEE Industrial Electronics Society, 2005. IECON 2005..

[22]  Bryan A. Jones,et al.  Practical kinematics for real-time implementation of continuum robots , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[23]  Patrick Doherty,et al.  Probabilistic roadmap based path planning for an autonomous unmanned helicopter , 2006, J. Intell. Fuzzy Syst..

[24]  Ehud Rivlin,et al.  Spline-Based Robot Navigation , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[25]  Gabriel Hugh Elkaim,et al.  Analysis of a Spline Based, Obstacle Avoiding Path Planning Algorithm , 2007, 2007 IEEE 65th Vehicular Technology Conference - VTC2007-Spring.

[26]  Salah Sukkarieh,et al.  Planning Continuous Curvature Paths for UAVs Amongst Obstacles , 2008 .

[27]  Kai Xu,et al.  An Investigation of the Intrinsic Force Sensing Capabilities of Continuum Robots , 2008, IEEE Transactions on Robotics.

[28]  Salah Sukkarieh,et al.  3D smooth path planning for a UAV in cluttered natural environments , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[29]  Salah Sukkarieh,et al.  Adaptive Nonlinear Model Predictive Path Tracking Control for a Fixed-Wing Unmanned Aerial Vehicle , 2009 .