Improve icubWholeBodyActuator

- do not set a control mode if the joint is already in that control mode
- a couple of bug fixed is iCubWholeBodySensors::readTorqueSensors (but
it is still bugged)
- remove useless prints in motorFrictionExcitation
conflict solved