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

This reverts commit 8cbc80cc3461744187c4d435d2603b44a4fc38c8.
Rebase from 'upstream'
Trimmed the branch to only the urdf_parser sub directory