Fixed #633, now reads multiple collision or visual elements in an urdf.