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

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