iCub programming Assignment