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

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