Inverse kinematics-based motion planning for dual-arm robot with orientation constraints

This article proposes an efficient and probabilistic complete planning algorithm to address motion planning problem involving orientation constraints for decoupled dual-arm robots. The algorithm is to combine sampling-based planning method with analytical inverse kinematic calculation, which randomly samples constraint-satisfying configurations on the constraint manifold using the analytical inverse kinematic solver and incrementally connects them to the motion paths in joint space. As the analytical inverse kinematic solver is applied to calculate constraint-satisfying joint configurations, the proposed algorithm is characterized by its efficiency and accuracy. We have demonstrated the effectiveness of our approach on the Willow Garage’s PR2 simulation platform by generating trajectory across a wide range of orientation-constrained scenarios for dual-arm manipulation.

[1]  Maxim Likhachev,et al.  Search-based planning for dual-arm manipulation with upright orientation constraints , 2012, 2012 IEEE International Conference on Robotics and Automation.

[2]  Lydia E. Kavraki,et al.  On the performance of random linear projections for sampling-based motion planning , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  José de Jesús Rubio,et al.  Discrete time control based in neural networks for pendulums , 2017, Appl. Soft Comput..

[4]  José de Jesús Rubio,et al.  Learning of operator hand movements via least angle regression to be teached in a manipulator , 2020, Evol. Syst..

[5]  Yahui Gan,et al.  Cooperative Path Planning and Constraints Analysis for Master-Slave Industrial Robots , 2012 .

[6]  John H. Reif,et al.  Complexity of the mover's problem and generalizations , 1979, 20th Annual Symposium on Foundations of Computer Science (sfcs 1979).

[7]  Thierry Siméon,et al.  A random loop generator for planning the motions of closed kinematic chains using PRM methods , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[8]  Frank Chongwoo Park,et al.  Tangent space RRT: A randomized planning algorithm on constraint manifolds , 2011, 2011 IEEE International Conference on Robotics and Automation.

[9]  Léonard Jaillet,et al.  Path Planning Under Kinematic Constraints by Rapidly Exploring Manifolds , 2013, IEEE Transactions on Robotics.

[10]  Dmitry Berenson,et al.  Learning Object Orientation Constraints and Guiding Constraints for Narrow Passages from One Demonstration , 2016, ISER.

[11]  Bruno Siciliano,et al.  Modelling and Control of Robot Manipulators , 1997, Advanced Textbooks in Control and Signal Processing.

[12]  Maxim Likhachev,et al.  Single- and dual-arm motion planning with heuristic search , 2014, Int. J. Robotics Res..

[13]  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).

[14]  Lydia E. Kavraki,et al.  The Open Motion Planning Library , 2012, IEEE Robotics & Automation Magazine.

[15]  Tamim Asfour,et al.  An integrated approach to inverse kinematics and path planning for redundant manipulators , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[16]  Siddhartha S. Srinivasa,et al.  Manipulation planning with Workspace Goal Regions , 2009, 2009 IEEE International Conference on Robotics and Automation.

[17]  Thierry Siméon,et al.  Sampling-Based Motion Planning under Kinematic Loop-Closure Constraints , 2004, WAFR.

[18]  Sachin Chitta,et al.  MoveIt! [ROS Topics] , 2012, IEEE Robotics Autom. Mag..

[19]  Christine Chevallereau,et al.  Toward optimal mapping of human dual-arm motion to humanoid motion for tasks involving contact with the environment , 2018 .

[20]  Siddhartha S. Srinivasa,et al.  Task Space Regions , 2011, Int. J. Robotics Res..

[21]  Jorge Angeles,et al.  Fundamentals of Robotic Mechanical Systems: Theory, Methods, and Algorithms , 1995 .

[22]  Sauro Longhi,et al.  Redundancy analysis of cooperative dual-arm manipulators , 2016 .

[23]  Danica Kragic,et al.  Dual arm manipulation - A survey , 2012, Robotics Auton. Syst..

[24]  Lydia E. Kavraki,et al.  A probabilistic roadmap approach for systems with closed kinematic chains , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

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

[26]  Martin Dekan,et al.  Moving obstacles detection based on laser range finder measurements , 2018 .

[27]  Wenfu Xu,et al.  Coordinated Resolved Motion Control of Dual-Arm Manipulators with Closed Chain , 2016 .

[28]  Frank Chongwoo Park,et al.  Tangent bundle RRT: A randomized algorithm for constrained motion planning , 2014, Robotica.

[29]  Maxim Likhachev,et al.  Motion planning for robotic manipulators with independent wrist joints , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[30]  Siddhartha S. Srinivasa,et al.  Regionally accelerated batch informed trees (RABIT*): A framework to integrate local information into optimal path planning , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[31]  Lydia E. Kavraki,et al.  Sampling-Based Methods for Motion Planning with Constraints , 2018, Annu. Rev. Control. Robotics Auton. Syst..

[32]  P. Bidaud,et al.  Analysis of a Robot Wrist Device for Mechanical Decoupling of End-Effector Position and Orientation , 1987 .

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

[34]  Danica Kragic,et al.  Robot Learning from Demonstration: A Task-level Planning Approach , 2008 .

[35]  Nancy M. Amato,et al.  A kinematics-based probabilistic roadmap method for high DOF closed chain systems , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[36]  Hesheng Wang,et al.  Manipulator motion planning using flexible obstacle avoidance based on model learning , 2017 .

[37]  Rina Dechter,et al.  Generating random solutions for constraint satisfaction problems , 2002, AAAI/IAAI.

[38]  Qing-Long Han,et al.  Mobile Robot Networks for Environmental Monitoring: A Cooperative Receding Horizon Temporal Logic Control Approach , 2019, IEEE Transactions on Cybernetics.

[39]  R. Paul,et al.  Computationally Efficient Kinematics for Manipulators with Spherical Wrists Based on the Homogeneous Transformation Representation , 1986 .

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

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

[42]  Lydia E. Kavraki,et al.  Atlas + X: Sampling-based Planners on Constraint Manifolds , 2017 .

[43]  Sachin Chitta,et al.  Motion planning with constraints using configuration space approximations , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[44]  Lei Wang,et al.  GART: An environment-guided path planner for robots in crowded environments under kinodynamic constraints , 2016 .

[45]  Lydia E. Kavraki,et al.  Randomized path planning for linkages with closed kinematic chains , 2001, IEEE Trans. Robotics Autom..

[46]  Nancy M. Amato,et al.  A Kinematics-Based Probabilistic Roadmap Method for Closed Chain Systems , 2001 .

[47]  Javaid Iqbal,et al.  On the Improvement of Multi-Legged Locomotion over Difficult Terrains Using a Balance Stabilization Method: , 2012 .

[48]  Emilio Frazzoli,et al.  Anytime Motion Planning using the RRT* , 2011, 2011 IEEE International Conference on Robotics and Automation.

[49]  Dmitry Berenson,et al.  Humanoid motion planning for dual-arm manipulation and re-grasping tasks , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[50]  M. Gharbi,et al.  A sampling-based path planner for dual-arm manipulation , 2008, 2008 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[51]  Siddhartha S. Srinivasa,et al.  Manipulation planning on constraint manifolds , 2009, 2009 IEEE International Conference on Robotics and Automation.

[52]  Xian Zhou,et al.  Closed-Chain Manipulation of Large Objects by Multi-Arm Robotic Systems , 2016, IEEE Robotics and Automation Letters.

[53]  Jose de Jesus Rubio,et al.  Modified optimal control with a backpropagation network for robotic arms , 2012 .

[54]  Léonard Jaillet,et al.  Randomized path planning on manifolds based on higher-dimensional continuation , 2012, Int. J. Robotics Res..