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

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