Made addDiagonal