iCub_SIM: impementation of positionDirect