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

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