Merged Alessandro changes. Added small changes in position control
Using mutex to write data into yarp fakebotFTsensor
Playing with torque control. Still not working...
Another experiment for reading torque that does not work...