Residual force polytope: Admissible task-space forces of dynamic trajectories

We propose a representation for the set of forces a robot can counteract using full system dynamics: the residual force polytope. Given the nominal torques required by a dynamic motion, this representation models the forces which can be sustained without interfering with that motion. The residual force polytope can be used to analyze and compare the set of admissible forces of different trajectories, but it can also be used to define metrics for solving optimization problems, such as in trajectory optimization or system design. We demonstrate how such a metric can be applied to trajectory optimization and compare it against other objective functions typically used. Our results show that the trajectories computed by optimizing objectives defined as functions of the residual force polytope are more robust to unknown external disturbances. The computational cost of these metrics is relatively high and not compatible with the short planning times required by online methods, but they are acceptable for planning motions offline.

[1]  F. Pierrot,et al.  Force polytope and force ellipsoid for redundant manipulators , 1997 .

[2]  Nicolas Mansard,et al.  Addressing Constraint Robustness to Torque Errors in Task-Space Inverse Dynamics , 2015, Robotics: Science and Systems.

[3]  Shuuji Kajita,et al.  A universal stability criterion of the foot contact of legged robots - adios ZMP , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[4]  Darwin G. Caldwell,et al.  Geometry-aware Tracking of Manipulability Ellipsoids , 2018, Robotics: Science and Systems.

[5]  Alan Edelman,et al.  Julia: A Fresh Approach to Numerical Computing , 2014, SIAM Rev..

[6]  Yiming Yang,et al.  Whole-Body End-Pose Planning for Legged Robots on Inclined Support Surfaces in Complex Environments , 2018, 2018 IEEE-RAS 18th International Conference on Humanoid Robots (Humanoids).

[7]  Quan Hu,et al.  Path Planning and Collision Avoidance for a Multi-Arm Space Maneuverable Robot , 2018, IEEE Transactions on Aerospace and Electronic Systems.

[8]  Sethu Vijayakumar,et al.  Dyadic collaborative Manipulation through Hybrid Trajectory Optimization , 2018, CoRL.

[9]  Moritz Diehl,et al.  A Family of Iterative Gauss-Newton Shooting Methods for Nonlinear Optimal Control , 2017, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[10]  Hsiu-Chin Lin,et al.  A Model-Based Hierarchical Controller for Legged Systems Subject to External Disturbances , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[11]  Russ Tedrake,et al.  A direct method for trajectory optimization of rigid bodies through contact , 2014, Int. J. Robotics Res..

[12]  Danna Zhou,et al.  d. , 1840, Microbial pathogenesis.

[13]  Komei Fukuda,et al.  Double Description Method Revisited , 1995, Combinatorics and Computer Science.

[14]  Martijn Wisse,et al.  Robust feedforward control of robotic arms with friction model uncertainty , 2015, Robotics Auton. Syst..

[15]  Stephen P. Boyd,et al.  Convex Optimization , 2004, Algorithms and Theory of Computation Handbook.

[16]  Dick den Hertog,et al.  Computing the Maximum Volume Inscribed Ellipsoid of a Polytopic Projection , 2015, INFORMS J. Comput..

[17]  Jorge Nocedal,et al.  Knitro: An Integrated Package for Nonlinear Optimization , 2006 .

[18]  Marco Hutter,et al.  Gait and Trajectory Optimization for Legged Systems Through Phase-Based End-Effector Parameterization , 2018, IEEE Robotics and Automation Letters.

[19]  Yuval Tassa,et al.  Control-limited differential dynamic programming , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

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

[21]  G. Ziegler.  Lectures on Polytopes , 1994 .

[22]  Nicolas Mansard,et al.  Crocoddyl: An Efficient and Versatile Framework for Multi-Contact Optimal Control , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[23]  D. Mayne.  A Second-order Gradient Method for Determining Optimal Trajectories of Non-linear Discrete-time Systems , 1966 .

[24]  Claudio Semini,et al.  On the Hardware Feasibility of Nonlinear Trajectory Optimization for Legged Locomotion based on a Simplified Dynamics , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[25]  Alexander W. Winkler.  Optimization-based motion planning for legged robots , 2018 .

[26]  John T. Betts,et al.  Practical Methods for Optimal Control and Estimation Using Nonlinear Programming , 2009 .

[27]  Abderrahmane Kheddar,et al.  3-D Robust Stability Polyhedron in Multicontact , 2018, IEEE Transactions on Robotics.

[28]  Arkadi Nemirovski,et al.  Robust Truss Topology Design via Semidefinite Programming , 1997, SIAM J. Optim..

[29]  Peter Corke,et al.  Maximising Manipulability During Resolved-Rate Motion Control , 2020, ArXiv.

[30]  S. Kuindersma,et al.  DIRTREL : Robust Nonlinear Direct Transcription with Ellipsoidal Disturbances and LQR Feedback , 2017 .

[31]  Oskar von Stryk,et al.  Direct and indirect methods for trajectory optimization , 1992, Ann. Oper. Res..

[32]  Darwin G. Caldwell,et al.  A Feasibility Metric for Trajectory Optimization of Legged Robots using Wrench Polytopes , 2017, ArXiv.