Removed IMU from config file for iCubHeidelber01 and fixed mem leak in yarpWholeBodyStates.cpp