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

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