Added some error checking.
If no constitutive relationship, only add diagonal elementts to
default unity output.