Add identity matrix and kroneker sum