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

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