Refactor wbiIcub interface in difference header files