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

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