Fix setControlMode(VOCAB_CM_FORCE_IDLE)

Improve compliance with new control mode specifications (http://wiki.icub.org/wiki/File:ICub_Control_Modes_1_1.pdf) and also solve fix bug related to robotMotorGui "Idle" button, that is ignored at the moment.