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

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