Что нужно добавить что бы заменить на ноль все элементы строк, в котором на главной диагонали стоит элемент равны 1.
//otvet.imgsmail.ru/download/17171216_09be6379fe3cb94b13e53158200a842b_800.jpg
достаточно кривой код, меняющий на главной диагонали 1 на 0 проходя зачем-то по всей матрице иди по строкам если диагональный элемент строки равен 1, пройди по всем столбцам и замени значения на 0