Real-time safe drop in replacements for some classes of iCub ctrlLib .