An analysis of RelaxedIK: an optimization-based framework for generating accurate and feasible robot arm motions

We present a real-time motion-synthesis method for robot manipulators, called RelaxedIK, that is able to not only accurately match end-effector pose goals as done by traditional IK solvers, but also create smooth, feasible motions that avoid joint-space discontinuities, self-collisions, and kinematic singularities. To achieve these objectives on-the-fly, we cast the standard IK formulation as a weighted-sum non-linear optimization problem, such that motion goals in addition to end-effector pose matching can be encoded as terms in the sum. We present a normalization procedure such that our method is able to effectively make trade-offs to simultaneously reconcile many, and potentially competing, objectives. Using these trade-offs, our formulation allows features to be relaxed when in conflict with other features deemed more important at a given time. We compare performance against a state-of-the-art IK solver and a real-time motion-planning approach in several geometric and real-world tasks on seven robot platforms ranging from 5-DOF to 8-DOF. We show that our method achieves motions that effectively follow position and orientation end-effector goals without sacrificing motion feasibility, resulting in more successful execution of tasks compared to the baseline approaches. We also empirically evaluate how our solver performs with different optimization solvers, gradient calculation methods, and choice of loss function in the objective function.

[1]  Bilge Mutlu,et al.  RelaxedIK: Real-time Synthesis of Accurate and Feasible Robot Arm Motion , 2018, Robotics: Science and Systems.

[2]  Anthony A. Maciejewski,et al.  Dealing with the ill-conditioned equations of motion for articulated figures , 1990, IEEE Computer Graphics and Applications.

[3]  Patrick Beeson,et al.  TRAC-IK: An open-source library for improved solving of generic inverse kinematics , 2015, 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids).

[4]  Bruno Siciliano,et al.  Closed-Loop Inverse Kinematics Schemes for Constrained Redundant Manipulators with Task Space Augmentation and Task Priority Strategy , 1991, Int. J. Robotics Res..

[5]  Stefano Chiaverini,et al.  Singularity-robust task-priority redundancy resolution for real-time kinematic control of robot manipulators , 1997, IEEE Trans. Robotics Autom..

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

[7]  Tsuneo Yoshikawa,et al.  Manipulability of Robotic Mechanisms , 1985 .

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

[9]  Kris Hauser Continuous Pseudoinversion of a Multivariate Function: Application to Global Redundancy Resolution , 2016, WAFR.

[10]  Olivier Stasse,et al.  A versatile Generalized Inverted Kinematics implementation for collaborative working humanoid robots: The Stack Of Tasks , 2009, ICAR.

[11]  Takeo Kanade,et al.  Automated Construction of Robotic Manipulation Programs , 2010 .

[12]  Ariel Shamir,et al.  Inverse Kinematics Techniques in Computer Graphics: A Survey , 2018, Comput. Graph. Forum.

[13]  Bilge Mutlu,et al.  An Autonomous Dynamic Camera Method for Effective Remote Teleoperation , 2018, 2018 13th ACM/IEEE International Conference on Human-Robot Interaction (HRI).

[14]  M. Powell A Direct Search Optimization Method That Models the Objective and Constraint Functions by Linear Interpolation , 1994 .

[15]  Giuseppe Oriolo,et al.  Motion Planning for Mobile Manipulators along Given End-effector Paths , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[16]  Bilge Mutlu,et al.  STAMPEDE: A Discrete-Optimization Method for Solving Pathwise-Inverse Kinematics , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[17]  Bilge Mutlu,et al.  Shared control–based bimanual robot manipulation , 2019, Science Robotics.

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

[19]  Sung Yong Shin,et al.  Computer puppetry: An importance-based approach , 2001, TOGS.

[20]  Oussama Khatib,et al.  Synthesis of Whole-Body Behaviors through Hierarchical Control of Behavioral Primitives , 2005, Int. J. Humanoid Robotics.

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

[22]  Bilge Mutlu,et al.  User-Guided Offline Synthesis of Robot Arm Motion from 6-DoF Paths , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[23]  Jehee Lee Representing Rotations and Orientations in Geometric Computing , 2008, IEEE Computer Graphics and Applications.

[24]  Yoshihiko Nakamura,et al.  Advanced robotics - redundancy and optimization , 1990 .

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

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

[27]  Krister Svanberg,et al.  A Class of Globally Convergent Optimization Methods Based on Conservative Convex Separable Approximations , 2002, SIAM J. Optim..

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

[29]  T. Flash,et al.  The coordination of arm movements: an experimentally confirmed mathematical model , 1985, The Journal of neuroscience : the official journal of the Society for Neuroscience.

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

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

[32]  A. A. Maciejewsk Dealing with the Ill-Conditioned Epuations of Motion for Articulated Figures , 1990 .

[33]  Ronan Boulic,et al.  An inverse kinematics architecture enforcing an arbitrary number of strict priority levels , 2004, The Visual Computer.

[34]  Emilio Frazzoli,et al.  Massively parallelizing the RRT and the RRT , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[35]  Clément Gosselin,et al.  Singularity analysis of closed-loop kinematic chains , 1990, IEEE Trans. Robotics Autom..

[36]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1986 .

[37]  Bilge Mutlu,et al.  A Motion Retargeting Method for Effective Mimicry-Based Teleoperation of Robot Arms , 2017, 2017 12th ACM/IEEE International Conference on Human-Robot Interaction (HRI.

[38]  Bilge Mutlu,et al.  Remote Telemanipulation with Adapting Viewpoints in Visually Complex Environments , 2019, Robotics: Science and Systems.

[39]  Oussama Khatib,et al.  A Unified Approach to Integrate Unilateral Constraints in the Stack of Tasks , 2009, IEEE Transactions on Robotics.

[40]  George Konidaris,et al.  Robot Motion Planning on a Chip , 2016, Robotics: Science and Systems.

[41]  Aude Billard,et al.  Coordinated multi-arm motion planning: Reaching for moving objects in the face of uncertainty , 2016, Robotics: Science and Systems.

[42]  Kris K. Hauser On responsiveness, safety, and completeness in real-time motion planning , 2012, Auton. Robots.

[43]  Bilge Mutlu,et al.  Shared Dynamic Curves: A Shared-Control Telemanipulation Method for Motor Task Training , 2018, HRI.