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

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