modified iCubTree serialization to reflect new API of kdl_codyco