New iCub control modes WIP