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

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