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

This reverts commit 39a2cbcd7ea7c7d65c4eda126a89661450826297.
Rebase from 'upstream' (no changes)
Trimmed the branch to only the kdl_parser sub directory