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

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