Сортировка массива, по возрастанию на главной диагонали

#include <stdio.h>
#define N 4
 
int main()
{
    int Matrix[N][N], i, j, TheGreatestElement = 0, RestDiagonal = 0;
/*Matrix - матрица N на N; i, j - индексы; TheGreatrstElement - наибольший эл-т;
RestDiagonal - диагональные эл-ты.*/
    int temp = 0, IndexI = 0, IndexJ = 0, counter=1;
/*temp - временная переменная; IndexI, IndexJ - позиция наибольшего эл-та,
counter - счётчик итераций.*/
 
/*Задаём матрицу.*/
    Matrix[0][0]=1;  Matrix[0][1]=9;  Matrix[0][2]=7;  Matrix[0][3]=10;
    Matrix[1][0]=3;  Matrix[1][1]=5;  Matrix[1][2]=2;  Matrix[1][3]=16;
    Matrix[2][0]=6;  Matrix[2][1]=8;  Matrix[2][2]=4;  Matrix[2][3]=13;
    Matrix[3][0]=14; Matrix[3][1]=11; Matrix[3][2]=12; Matrix[3][3]=15;
 
/*Вывод.*/
    for(i = 0; i < N; i++)
    {
        for(j = 0; j < N; j++)
        {
            printf("%d\t", Matrix[i][j]);
        }
        printf("\n");
    }
    printf("\n");
 
/*Первый проход поместит на позицию [0][0] наибольший элемент.*/
    for(i = 0; i < N; i++)
    {
        for(j = 0; j < N; j++)
        {
             if(Matrix[i][j]>TheGreatestElement)
             {
/*Если текущий элемент больше наибольшего, то делаем его наибольшим.*/
                 TheGreatestElement = Matrix[i][j];
/*И запоминаем индексы.*/
                 IndexI = i;
                 IndexJ = j;
             }
        }
    }
/*Дальше меняем местами наибольший и [0][0].*/
    temp = Matrix[IndexI][IndexJ];
    Matrix[IndexI][IndexJ] = Matrix[0][0];
    Matrix[0][0] = temp;
    
/*Теперь заполняем остальную диагональ. Нам нужно заполнить 
оставшиеся три элемента: [1][1], [2][2] и [3][3].*/
    while(counter < N)
    {
        for(i = 0; i < N; i++)
        {
            for(j = 0; j < N; j++)
            {
/*Условие немного посложнее. Нам нужно, чтобы элемент был вторым по
большинству, то есть, меньше наибольшего.*/
                if(Matrix[i][j]>RestDiagonal&&Matrix[i][j]<TheGreatestElement)
                {
/*Запоминаем его и индексы.*/
                     RestDiagonal = Matrix[i][j];
                     IndexI = i;
                     IndexJ = j;
                }
            }
        }
/*Дальше меняем текущий элемент с диагональным.*/
        temp = Matrix[IndexI][IndexJ];
        Matrix[IndexI][IndexJ] = Matrix[counter][counter];
        Matrix[counter][counter] = temp;
/*А здесь наибольшим становится текущий элемент, постольку поскольку,
нам нужен будет уже третий по старшинству и т.д.*/
        TheGreatestElement = RestDiagonal;
/*Обнуляем то, с чем будем сравнивать. (Кстати, если в матрице только 
отрицательные эл-ты, то 0 нужно заменить на наименьшее отрицательное.*/
        RestDiagonal = 0;
        counter++;
    }
 
/*Здесь просто вывод.*/
    for(i = 0; i < N; i++)
    {
        for(j = 0; j < N; j++)
        {
            printf("%d\t", Matrix[i][j]);
        }
        printf("\n");
    }
}