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

This reverts commit 8635f24e5e45c827ec809ac57189f30789441aaf.
Rebase from 'upstream' (no changes)
Trimmed the branch to only the p2os_urdf sub directory