Added global mutex as in previous (iCub) version