whole-body control

iCub Whole-Body Control through Force Regulation on Rigid Non-Coplanar Contacts