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

This reverts commit a10ab734f2dbb366ea2fecdc0e6d93760b87db61.
Rebase from 'upstream'
Trimmed the branch to only the p2os_urdf sub directory