Fixed zero for matrices.
Added diag/diagm.