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

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