KDL_codyco now uses KDL-defined macros to properly map to either shared_pointer or objects