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

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