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

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