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

This reverts commit 2027c877c68c6d1d6fa8822405f05c3991176dea.
Rebase from 'upstream'
Trimmed the branch to only the urdf_parser_plugin sub directory