Synthesis of whole-body behaviors through hierarchical control of behavioral primitives
A unified approach for motion and force control of robot manipulators: The operational space formulation