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

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