Update icubWholeBodyModel.cpp