Multi-Contact Whole-Body Force Control for Position-Controlled Robots (2312.16465v4)
Abstract: Many humanoid and multi-legged robots are controlled in positions rather than in torques, which prevents direct control of contact forces, and hampers their ability to create multiple contacts to enhance their balance, such as placing a hand on a wall or a handrail. This letter introduces the SEIKO (Sequential Equilibrium Inverse Kinematic Optimization) pipeline, and proposes a unified formulation that exploits an explicit model of flexibility to indirectly control contact forces on traditional position-controlled robots. SEIKO formulates whole-body retargeting from Cartesian commands and admittance control using two quadratic programs solved in real-time. Our pipeline is validated with experiments on the real, full-scale humanoid robot Talos in various multi-contact scenarios, including pushing tasks, far-reaching tasks, stair climbing, and stepping on sloped surfaces. Code and videos are available at: https://hucebot.github.io/seiko_controller_website/
- C. G. Atkeson et al., “What happened at the darpa robotics challenge finals,” The DARPA robotics challenge finals: Humanoid robots to the rescue, 2018.
- R. Cisneros-Limon et al., “An inverse dynamics-based multi-contact locomotion control framework without joint torque feedback,” Advanced Robotics, 2020.
- B. Henze, M. A. Roa, and C. Ott, “Passivity-based whole-body balancing for torque-controlled humanoid robots in multi-contact scenarios,” Int. Journal of Robotics Research, 2016.
- F. Abi-Farraj et al., “Torque-based balancing for a humanoid robot performing high-force interaction tasks,” IEEE RA-L, 2019.
- N. Ramuzat et al., “Actuator model, identification and differential dynamic programming for a talos humanoid robot,” in IEEE ECC, 2020.
- G. Romualdi et al., “A benchmarking of dcm-based architectures for position, velocity and torque-controlled humanoid robots,” International Journal of Humanoid Robotics, 2020.
- G. Nava, D. Pucci, and F. Nori, “Momentum control of humanoid robots with series elastic actuators,” in IEEE/RSJ IROS, 2017.
- O. Stasse et al., “Talos: A new humanoid research platform targeted for industrial applications,” in IEEE-RAS Humanoids, 2017.
- N. A. Villa et al., “Torque controlled locomotion of a biped robot with link flexibility,” in IEEE-RAS Humanoids, 2022.
- Q. Rouxel, K. Yuan, R. Wen, and Z. Li, “Multicontact motion retargeting using whole-body optimization of full kinematics and sequential force equilibrium,” Trans. on Mechatronics, 2022.
- R. Wen, Q. Rouxel, M. Mistry, Z. Li, and C. Tiseo, “Collaborative bimanual manipulation using optimal motion adaptation and interaction control,” IEEE RAM, 2023.
- Q. Rouxel, R. Wen, Z. Li, C. Tiseo, J.-B. Mouret, and S. Ivaldi, “Feasibility retargeting for multi-contact teleoperation and physical interaction,” 2nd Workshop Toward Robot Avatars, ICRA, 2023.
- K. Darvish et al., “Teleoperation of humanoid robots: A survey,” IEEE Trans. on Robotics, 2023.
- A. Di Fava et al., “Multi-contact motion retargeting from human to humanoid robot,” in IEEE-RAS Humanoids, 2016.
- S. McCrory, S. Bertrand, D. Calvert, J. Pratt, and R. Griffin, “A virtual-reality driven approach for generating humanoid multi-contact trajectories,” arXiv preprint arXiv:2303.08232, 2023.
- F. Ruscelli et al., “A multi-contact motion planning and control strategy for physical interaction tasks using a humanoid robot,” in IEEE/RSJ IROS, 2020.
- M. P. Polverini et al., “Multi-contact heavy object pushing with a centaur-type humanoid robot: Planning and control for a real demonstrator,” IEEE RA-L, 2020.
- Z. Li et al., “Stabilization for the compliant humanoid robot coman exploiting intrinsic and controlled compliance,” in IEEE ICRA, 2012.
- J. Vaillant et al., “Multi-contact vertical ladder climbing with an hrp-2 humanoid,” Autonomous Robots, 2016.
- S. Kajita et al., “Biped walking stabilization based on linear inverted pendulum tracking,” in IEEE/RSJ IROS, 2010.
- S. Caron, A. Kheddar, and O. Tempier, “Stair climbing stabilization of the hrp-4 humanoid robot using whole-body admittance control,” in IEEE ICRA, 2019.
- R. Cisneros et al., “Qp-based task-space hybrid/parallel control for multi-contact motion in a torque-controlled humanoid robot,” in IEEE-RAS Humanoids, 2019.
- S. Samadi et al., “Balance of humanoid robots in a mix of fixed and sliding multi-contact scenarios,” in IEEE ICRA, 2020.
- ——, “Humanoid control under interchangeable fixed and sliding unilateral contacts,” IEEE RA-L, 2021.
- O. Khatib et al., “Torque-position transformer for task control of position controlled robots,” in IEEE ICRA, 2008.
- A. Del Prete et al., “Implementing torque control with high-ratio gear boxes and without joint-torque sensors,” Int. Journal of Humanoid Robotics, 2016.
- E. Farnioli, M. Gabiccini, and A. Bicchi, “Optimal contact force distribution for compliant humanoid robots in whole-body loco-manipulation tasks,” in IEEE ICRA, 2015.
- ——, “Toward whole-body loco-manipulation: Experimental results on multi-contact interaction with the walk-man robot,” in IEEE/RSJ IROS, 2016.
- N. Hiraoka et al., “Online generation and control of quasi-static multi-contact motion by pwt jacobian matrix with contact wrench estimation and joint load reduction,” Advanced Robotics, 2021.
- S. Caron, Q.-C. Pham, and Y. Nakamura, “Stability of surface contacts for humanoid robots: Closed-form formulae of the contact wrench cone for rectangular support areas,” in IEEE ICRA, 2015.
- K. H. Koch, K. Mombaur, O. Stasse, and P. Soueres, “Optimization based exploitation of the ankle elasticity of hrp-2 for overstepping large obstacles,” in IEEE-RAS Humanoids, 2014.
- M. L. Felis, “Rbdl: an efficient rigid-body dynamics library using recursive algorithms,” Autonomous Robots, 2016.
- J. Carpentier et al., “The pinocchio c++ library – a fast and flexible implementation of rigid body dynamics algorithms and their analytical derivatives,” in IEEE SII, 2019.
- D. Goldfarb and A. Idnani, “A numerically stable dual method for solving strictly convex quadratic programs,” Mathematical programming, 1983.