Fix bug in setControlReference of actuator interface

- fix bug in setControlReference of icubWholeBodyActuators, which was
detectable only on the robot (not in simulation) due to the different
implementation of velocity control (see iVelocityControl2 in yarp)
- add check in icubWholeBodySensors::openPwm
- comment debug prints in motorFrictionExcitation