A path space approach to nonholonomic motion planning in the presence of obstacles

This paper presents an algorithm for finding a kinematically feasible path for a nonholonomic system in the presence of obstacles. We first consider the path planning problem without obstacles by transforming it into a nonlinear least squares problem in an augmented space which is then iteratively solved. Obstacle avoidance is included as inequality constraints. Exterior penalty functions are used to convert the inequality constraints Into equality constraints. Then the same nonlinear least squares approach is applied. We demonstrate the efficacy of the approach by solving some challenging problems, including a tractor-trailer and a tractor with a steerable trailer backing in a loading dock. These examples demonstrate the performance of the algorithm in the presence of obstacles and steering and jackknife angle constraints.

[1]  John T. Wen,et al.  A path space approach to nonholonomic motion planning in the presence of obstacles , 1997, IEEE Trans. Robotics Autom..

[2]  Ole Jakob Sørdalen,et al.  Conversion of the kinematics of a car with n trailers into a chained form , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[3]  S. Sastry,et al.  Nonholonomic motion planning: steering using sinusoids , 1993, IEEE Trans. Autom. Control..

[4]  Jean-Claude Latombe,et al.  Numerical potential field techniques for robot path planning , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[5]  S. Sastry,et al.  Steering nonholonomic systems using sinusoids , 1990, 29th IEEE Conference on Decision and Control.

[6]  Steven Dubowsky,et al.  On the dynamics of manipulators in space using the virtual manipulator approach , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[7]  R. W. Brockett,et al.  Asymptotic stability and feedback stabilization , 1982 .

[8]  D. Bertsekas,et al.  A Vector Space Approach to Models and Optimization , 1983 .

[9]  Zexiang Li,et al.  Motion of two rigid bodies with rolling constraint , 1990, IEEE Trans. Robotics Autom..

[10]  S. LaValle,et al.  Motion Planning , 2008, Springer Handbook of Robotics.

[11]  John T. Wen,et al.  Nonholonomic path-planning with obstacle avoidance: a path-space approach , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[12]  Bart Kosko,et al.  Adaptive fuzzy systems for backing up a truck-and-trailer , 1992, IEEE Trans. Neural Networks.

[13]  Yoshihiko Nakamura,et al.  Nonholonomic path planning of space robots via bi-directional approach , 1990, Proceedings., IEEE International Conference on Robotics and Automation.

[14]  John F. Canny,et al.  Using skeletons for nonholonomic path planning among obstacles , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

[15]  Georges Bastin,et al.  Modelling and control of non-holonomic wheeled mobile robots , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[16]  Jean-Paul Laumond,et al.  A motion planner for car-like robots based on a mixed global/local approach , 1990, EEE International Workshop on Intelligent Robots and Systems, Towards a New Frontier of Applications.

[17]  Stephen Cameron,et al.  Motion planning for non-holonomic industrial robot vehicles , 1991, Proceedings IROS '91:IEEE/RSJ International Workshop on Intelligent Robots and Systems '91.

[18]  Jean-Paul Laumond,et al.  Controllability of a multibody mobile robot , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[19]  John F. Canny,et al.  Robust motion planning for mobile robots , 1990, Proceedings., IEEE International Conference on Robotics and Automation.

[20]  Giuseppe Oriolo,et al.  Free-joint manipulators: motion control under second-order nonholonomic constraints , 1991, Proceedings IROS '91:IEEE/RSJ International Workshop on Intelligent Robots and Systems '91.

[21]  Christian Laugier,et al.  On line reactive planning for a nonholonomic mobile in a dynamic world , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[22]  H. Sussmann,et al.  A continuation method for nonholonomic path-finding problems , 1993, Proceedings of 32nd IEEE Conference on Decision and Control.

[23]  Gerardo Lafferriere,et al.  Motion planning for controllable systems without drift , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[24]  J. Zabczyk.  Some comments on stabilizability , 1989 .

[25]  Eduardo Sontag.  Control of systems without drift via generic loops , 1995, IEEE Trans. Autom. Control..

[26]  Dan Koditschek,et al.  Natural motion for robot arms , 1984, The 23rd IEEE Conference on Decision and Control.

[27]  Leo Dorst,et al.  The geometrical representation of path planning problems , 1991, Robotics Auton. Syst..

[28]  A. Bloch,et al.  Controllability and stabilizability properties of a nonholonomic control system , 1990, 29th IEEE Conference on Decision and Control.