Some clean-up of URDF parser: Remove ability to parse object URDF files, remove double code.

More clean-up necessary.