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

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