Fixes for the pr2.urdf