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

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