Add initial error check when parsing URDF.

There was a lack of early error checking when parsing a URDF file.