Simulink Toolbox for rapid prototyping of Whole Body Controllers