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

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