Smooth Curve Fitting of Mobile Robot Trajectories Using Differential Evolution

Mobile robots have recently attracted the attention and applicability in field areas ubiquitously. Within the context of autonomous navigation, path planning is relevant for comfortability, safety, execution time and energy savings. In this paper, we propose an approach to suggest smooth paths from observed robot trajectories by optimizing fitting and smoothness criteria using Differential Evolution with distinct modes of initialization, selection pressure, exploration and exploitation. Our rigorous computational experiments using a relevant set of real-world robot trajectories from the Boe-Bot mobile robot architecture show the feasibility and efficiency of our approach in computing smooth curves, suggesting the superior performance of the greedy initialization scheme based on the triangular convex hull of the robot trajectory, and Differential Evolution with exploitative and parameter adaptation schemes such as Rank-Based Differential Evolution (RBDE), Adaptive Differential Evolution with External Archive (JADE) and Strategy Adaptation Differential Evolution (SADE). Our obtained results offer the building blocks to further advance towards developing data-driven curve fitting and path planning algorithms, which may find use in several real-world applications in Robotics and Operations Research.

[1]  Nils J. Nilsson,et al.  A Formal Basis for the Heuristic Determination of Minimum Cost Paths , 1968, IEEE Trans. Syst. Sci. Cybern..

[2]  Shuchun Wang,et al.  Designing fair curves using monotone curvature pieces , 2004, Comput. Aided Geom. Des..

[3]  Gerald E. Farin,et al.  Automatic fairing algorithm for B-spline curves , 1990, Comput. Aided Des..

[4]  Il Hong Suh,et al.  Bezier Curve-Based Smoothing for Path Planner with Curvature Constraint , 2017, 2017 First IEEE International Conference on Robotic Computing (IRC).

[5]  Ali Hashemian,et al.  An integrated fitting and fairing approach for object reconstruction using smooth NURBS curves and surfaces , 2018, Comput. Math. Appl..

[6]  Seiichi Mita,et al.  Bézier curve based path planning for autonomous vehicle in urban environment , 2010, 2010 IEEE Intelligent Vehicles Symposium.

[7]  D. T. Lee,et al.  Euclidean shortest paths in the presence of rectilinear barriers , 1984, Networks.

[8]  Andrés Iglesias,et al.  A new iterative mutually coupled hybrid GA-PSO approach for curve fitting in manufacturing , 2013, Appl. Soft Comput..

[9]  Siddhartha S. Srinivasa,et al.  CHOMP: Gradient optimization techniques for efficient motion planning , 2009, 2009 IEEE International Conference on Robotics and Automation.

[10]  Nan Chen,et al.  Adaptive B-spline knot selection using multi-resolution basis set , 2013 .

[11]  Pieter Abbeel,et al.  Motion planning with sequential convex optimization and convex collision checking , 2014, Int. J. Robotics Res..

[12]  Tomoyuki Miyashita,et al.  Towards bundling minimal trees in polygonal maps , 2018, GECCO.

[13]  Kalevi Huhtala,et al.  Constrained path optimization with Bézier curve primitives , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[14]  Tomoyuki Miyashita,et al.  Optimization of route bundling via differential evolution with a convex representation , 2017, 2017 IEEE International Conference on Real-time Computing and Robotics (RCAR).

[15]  Carlos F. Borges,et al.  Total least squares fitting of Bézier and B-spline curves to ordered data , 2002, Comput. Aided Geom. Des..

[16]  David González,et al.  Continuous curvature planning with obstacle avoidance capabilities in urban scenarios , 2014, 17th International IEEE Conference on Intelligent Transportation Systems (ITSC).

[17]  Lingli Yu,et al.  A Path Planning and Navigation Control System Design for Driverless Electric Bus , 2018, IEEE Access.

[18]  Tomoyuki Miyashita,et al.  Route bundling in polygonal domains using Differential Evolution , 2017, Robotics and biomimetics.

[19]  Erkan Ülker,et al.  B-spline curve fitting with invasive weed optimization , 2017 .

[20]  Seiichi Mita,et al.  Dynamic and Safe Path Planning Based on Support Vector Machine among Multi Moving Obstacles for Autonomous Vehicles , 2013, IEICE Trans. Inf. Syst..

[21]  Kai Oliver Arras,et al.  RRT-based nonholonomic motion planning using any-angle path biasing , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[22]  Emilio Frazzoli,et al.  A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles , 2016, IEEE Transactions on Intelligent Vehicles.

[23]  Carlo H. Séquin,et al.  6. Minimum Variation Curves and Surfaces for Computer-Aided Geometric Design , 1994, Designing Fair Curves and Surfaces.

[24]  Caiming Zhang,et al.  Adaptive knot placement using a GMM-based continuous optimization algorithm in B-spline curve approximation , 2011, Comput. Aided Des..

[25]  Celso C. Ribeiro,et al.  Curve and surface fitting by implicit polynomials: Optimum degree finding and heuristic refinement , 2017, Comput. Graph..

[26]  Ashwini Ratnoo,et al.  Smooth path planning for passages with heading and curvature discontinuities , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[27]  Tomoyuki Miyashita,et al.  Path Planning on Hierarchical Bundles with Differential Evolution , 2018, ICSI.

[28]  Parque Victor,et al.  Comparative Analysis of Aesthetic Surfaces , 2016 .

[29]  Stefan Schaal,et al.  STOMP: Stochastic trajectory optimization for motion planning , 2011, 2011 IEEE International Conference on Robotics and Automation.

[30]  P. N. Suganthan,et al.  Differential Evolution Algorithm With Strategy Adaptation for Global Numerical Optimization , 2009, IEEE Transactions on Evolutionary Computation.

[31]  Rainer Storn,et al.  Differential Evolution – A Simple and Efficient Heuristic for global Optimization over Continuous Spaces , 1997, J. Glob. Optim..

[32]  Gaurav S. Sukhatme,et al.  Gradient-Informed Path Smoothing for Wheeled Mobile Robots , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[33]  Valdir Grassi,et al.  Clothoid-Based Global Path Planning for Autonomous Vehicles in Urban Scenarios , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[34]  Bernard Chazelle,et al.  A theorem on polygon cutting with applications , 1982, 23rd Annual Symposium on Foundations of Computer Science (sfcs 1982).

[35]  Mohamed Elhoseny,et al.  Bezier Curve Based Path Planning in a Dynamic Field using Modified Genetic Algorithm , 2017, J. Comput. Sci..

[36]  Andrew M. Sutton,et al.  Differential evolution and non-separability: using selective pressure to focus search , 2007, GECCO '07.

[37]  Shigenori Sano,et al.  Real-time obstacle-avoidance motion planning for autonomous mobile robots , 2014, 2014 4th Australian Control Conference (AUCC).

[38]  Jari Saarinen,et al.  Fast, continuous state path smoothing to improve navigation accuracy , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[39]  Andrés Iglesias,et al.  Elitist clonal selection algorithm for optimal choice of free knots in B-spline data fitting , 2015, Appl. Soft Comput..

[40]  Eduardo Segredo,et al.  A novel similarity-based mutant vector generation strategy for differential evolution , 2018, GECCO.

[41]  Arthur C. Sanderson,et al.  JADE: Adaptive Differential Evolution With Optional External Archive , 2009, IEEE Transactions on Evolutionary Computation.

[42]  Edsger W. Dijkstra,et al.  A note on two problems in connexion with graphs , 1959, Numerische Mathematik.