wbd nearly working in iCubHeidelberg01