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

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