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

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