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

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