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

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