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

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