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

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