A sampling-based optimized algorithm for task-constrained motion planning

We consider a motion planning problem with task space constraints in a complex environment for redundant manipulators. For this problem, we propose a motion planning algorithm that combines kinematics control with rapidly exploring random sampling methods. Meanwhile, we introduce an optimization structure similar to dynamic programming into the algorithm. The proposed algorithm can generate an asymptotically optimized smooth path in joint space, which continuously satisfies task space constraints and avoids obstacles. We have confirmed that the proposed algorithm is probabilistically complete and asymptotically optimized. Finally, we conduct multiple experiments with path length and tracking error as optimization targets and the planning results reflect the optimization effect of the algorithm.

[1]  Yasar Ayaz,et al.  RRT*-SMART: A Rapid Convergence Implementation of RRT* , 2013 .

[2]  Steven M. LaValle,et al.  Rapidly-Exploring Random Trees: Progress and Prospects , 2000 .

[3]  Marilena Vendittelli,et al.  Repeatable Motion Planning for Redundant Robots Over Cyclic Tasks , 2017, IEEE Transactions on Robotics.

[4]  Ji Xiang,et al.  Clamping weighted least-norm method for the manipulator kinematic control with constraints , 2016, Int. J. Control.

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

[6]  Giuseppe Oriolo,et al.  Stabilization of self-motions in redundant robots , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[7]  Ji Xiang,et al.  Clamping weighted least-norm method for the manipulator kinematic control: Avoiding joint limits , 2014, Proceedings of the 33rd Chinese Control Conference.

[8]  Charles A. Klein,et al.  Review of pseudoinverse control for use with kinematically redundant manipulators , 1983, IEEE Transactions on Systems, Man, and Cybernetics.

[9]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[10]  Dinesh Manocha,et al.  FCL: A general purpose library for collision and proximity queries , 2012, 2012 IEEE International Conference on Robotics and Automation.

[11]  S. LaValle.  Rapidly-exploring random trees : a new tool for path planning , 1998 .

[12]  Marilena Vendittelli,et al.  A control-based approach to task-constrained motion planning , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  Giuseppe Oriolo,et al.  Kinematically Redundant Manipulators , 2008, Springer Handbook of Robotics.

[14]  Mike Stilman,et al.  Task constrained motion planning in robot joint space , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  John Baillieul,et al.  Resolution of Kinematic Redundancy using Optimization Techniques , 1988, 1988 American Control Conference.

[16]  Lydia E. Kavraki,et al.  Probabilistic roadmaps for path planning in high-dimensional configuration spaces , 1996, IEEE Trans. Robotics Autom..

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

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

[19]  Bruno Siciliano,et al.  Kinematic control of redundant robot manipulators: A tutorial , 1990, J. Intell. Robotic Syst..

[20]  Philippe Wenger,et al.  Cuspidal and noncuspidal robot manipulators , 2007, Robotica.

[21]  Giuseppe Oriolo,et al.  The reduced gradient method for solving redundancy in robot arms , 1990, Robotersysteme.

[22]  O. Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[23]  Marilena Vendittelli,et al.  Probabilistic motion planning for redundant robots along given end-effector paths , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[24]  Arati Suresh Deo.  Application of optimal damped least-squares method to inverse kinematics of robotic manipulators , 1991 .

[25]  A. Matveev,et al.  Algorithms for collision-free navigation of mobile robots in complex cluttered environments: a survey , 2014, Robotica.

[26]  Stephen Cameron,et al.  The Virtual Springs Method: Path Planning and Collision Avoidance for Redundant Manipulators , 1996, Int. J. Robotics Res..

[27]  Planning safe cyclic motions under repetitive task constraints , 2013, 2013 IEEE International Conference on Robotics and Automation.

[28]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[29]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[30]  Shuai He,et al.  An improved artificial potential field method of trajectory planning and obstacle avoidance for redundant manipulators , 2018, International Journal of Advanced Robotic Systems.

[31]  Byron Boots,et al.  Gaussian Process Motion planning , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).