Revert "Trimmed the branch to only the kdl_conversions sub directory"

This reverts commit c088fef9f5cf69e66bd46f00f5a905f747d0531b.
Rebase from 'upstream'
Trimmed the branch to only the kdl_conversions sub directory