Inverse kinematics with floating base and constraints for full body humanoid robot control
A unified approach for motion and force control of robot manipulators: The operational space formulation