Updated the p2os_urdf package to work properly.
cleaned up