Copied kdl_codyco-config from working kdl one