Whole-Body Motion Synthesis with LQP-Based Controller – Application to iCub

This paper deals with the dynamic control of humanoid robots interacting with their environment, and more specifically the behavioral synthesis for dynamic tasks. The particular problem that is considered here is the sequencing of elementary activities subjected to physical constraints, both internal as torque limits and external as contacts, within the framework of posture/tasks coordination. For that we propose to convert the set of tasks into weighted quadratic functions and to minimize their cost with a Linear Quadratic Program. The combination of elementary tasks leads to complex actions, and the continuous evolution of the weights ensures smooth transitions over time, as it is shown in the results.