Fix problem for block diagonal global matrix