Turned off mutex, making problems with orocos