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

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