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

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