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

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