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

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