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

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