Migrated iDynTree from kdl_codyco 0.0.1 to kdl_codyco 0.0.2