Fixed bug in icubWholeBodyModel convertQ, convertDQ, convertDDQ