Fixed else matching to wrong if in building urdf scene

Also added check for no material tag in urdf