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

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