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

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