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

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