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

This reverts commit f2b96937c9b37aa35eb6b86abbcbac8b430c02d1.
Rebase from 'upstream'
Trimmed the branch to only the kdl_parser sub directory