Jerk Control of Floating Base Systems With Contact-Stable Parameterized Force Feedback

Nonlinear controllers for floating base systems in contact with the environment are often framed as quadratic programming (QP) optimization problems. Common drawbacks of such QP based controllers are: the friction cone constraints are approximated with a set of linear inequalities; the control input often experiences discontinuities; no force feedback from Force/Torque (FT) sensors installed on the robot is taken into account. This paper attempts at addressing these limitations through the design of jerk controllers. These controllers assume the rate-of-change of the joint torques as control input, and exploit the system position, velocity, accelerations, and contact wrenches as measurable quantities. The key ingredient of the presented approach is a one-to-one correspondence between free variables and the manifold defined by the contact stability constraints. This parametrisation allows us to transform the underlying constrained optimisation problems into one that is unconstrained. Then, we propose a jerk control framework that exploits the proposed parametrisation and uses FT measurements in the control loop. Furthermore, we present Lyapunov stable controllers for the system momentum in the jerk control framework. The approach is validated with simulations and experiments using the iCub humanoid robot.

[1]  David E. Orin,et al.  Centroidal Momentum Matrix of a humanoid robot: Structure and properties , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Alberto Isidori,et al.  The zero dynamics of a nonlinear system: FrOm The Origin To the latest progresses of a long successful story , 2011, Proceedings of the 30th Chinese Control Conference.

[3]  Stefan Schaal,et al.  Inverse dynamics control of floating base systems using orthogonal decomposition , 2010, 2010 IEEE International Conference on Robotics and Automation.

[4]  Daniele Pucci,et al.  On-line joint limit avoidance for torque controlled robots by joint space parametrization , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[5]  Abderrahmane Kheddar,et al.  Quadratic Programming for Multirobot and Task-Space Force Control , 2019, IEEE Transactions on Robotics.

[6]  Adrien Escande,et al.  Capturability-Based Pattern Generation for Walking With Variable Height , 2018, IEEE Transactions on Robotics.

[7]  Daniele Pucci,et al.  A Unified View of the Equations of Motion used for Control Design of Humanoid Robots The Role of the Base Frame in Free-Floating Mechanical Systems and its Connection to Centroidal Dynamics , 2017 .

[8]  Nicolas Mansard,et al.  Analytical Derivatives of Rigid Body Dynamics Algorithms , 2018, Robotics: Science and Systems.

[9]  Roy Featherstone,et al.  Rigid Body Dynamics Algorithms , 2007 .

[10]  Giulio Sandini,et al.  The iCub humanoid robot: An open-systems platform for research in cognitive development , 2010, Neural Networks.

[11]  Jessy W. Grizzle,et al.  A Finite-State Machine for Accommodating Unexpected Large Ground-Height Variations in Bipedal Robot Walking , 2013, IEEE Transactions on Robotics.

[12]  Luigi Villani,et al.  Force Control in Robotics , 2015, Encyclopedia of Systems and Control.

[13]  Vincent Padois,et al.  Reactive whole-body control for humanoid balancing on non-rigid unilateral contacts , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[14]  A. Van,et al.  Lagrangian Mechanics , 2018, Modern Classical Mechanics.

[15]  Twan Koolen,et al.  Design of a Momentum-Based Control Framework and Application to the Humanoid Robot Atlas , 2016, Int. J. Humanoid Robotics.

[16]  Gerd Hirzinger,et al.  Posture and balance control for biped robots based on contact force optimization , 2011, 2011 11th IEEE-RAS International Conference on Humanoid Robots.

[17]  Valerio Ortenzi,et al.  Hybrid motion/force control: a review , 2017, Adv. Robotics.

[18]  Mark W. Spong,et al.  Underactuated mechanical systems , 1998 .

[19]  Tsuneo Yoshikawa,et al.  Force control of robot manipulators , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[20]  Alexander Leonessa,et al.  Design of a compliant bipedal walking controller for the DARPA Robotics Challenge , 2015, 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids).

[21]  Alin Albu-Schäffer,et al.  Passivity Analysis and Control of Humanoid Robots on Movable Ground , 2018, IEEE Robotics and Automation Letters.

[22]  Carlos Canudas de Wit,et al.  Motion and force control , 1996 .

[23]  John J. Craig,et al.  Hybrid position/force control of manipulators , 1981 .

[24]  Andrew Howard,et al.  Design and use paradigms for Gazebo, an open-source multi-robot simulator , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[25]  Daniele Pucci,et al.  iCub Whole-Body Control through Force Regulation on Rigid Non-Coplanar Contacts , 2015, Front. Robot. AI.

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

[27]  R. Stephenson A and V , 1962, The British journal of ophthalmology.

[28]  Michael N. Mistry,et al.  Balance control strategy for legged robots with compliant contacts , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[29]  Oussama Khatib,et al.  Control of Free-Floating Humanoid Robots Through Task Prioritization , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[30]  David E. Orin,et al.  Generation of dynamic humanoid behaviors through task-space control with conic optimization , 2013, 2013 IEEE International Conference on Robotics and Automation.

[31]  Jerrold E. Marsden,et al.  Introduction to Mechanics and Symmetry: A Basic Exposition of Classical Mechanical Systems , 1999 .

[32]  Gabriele Nava,et al.  A Control Architecture with Online Predictive Planning for Position and Torque Controlled Walking of Humanoid Robots , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[33]  Moritz Diehl,et al.  CasADi: a software framework for nonlinear optimization and optimal control , 2018, Mathematical Programming Computation.

[34]  Sung-Hee Lee,et al.  A momentum-based balance controller for humanoid robots on non-level and non-stationary ground , 2012, Auton. Robots.

[35]  Vincent Padois,et al.  Whole-body hierarchical motion and force control for humanoid robots , 2016, Auton. Robots.

[36]  Gabriele Nava,et al.  Stability analysis and design of momentum-based controllers for humanoid robots , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).