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

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