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

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