iCub_SIM: added implementation of most part of the IVelocityControl2,
get/set pid are to be implemented