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

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