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

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