Нахождения оптимального пути

[linkoln_7]

Доброго времени суток!
Прошу у вас помощи)
Есть задача на поиск оптимального пути
Алгоритм задачи:
1)А-массив,описывающий значение коэффициентов по строкам,размерность [6][5]
2)В-массив,описывающий значение коэффициентов по столбцам ,размерность [6][5]
3)С-массив,описывающий значение в узлах решетки [6][6]
4)D-массив,описывающий найденный путь [6][6]

В итоге должна получится матрица,в которой другим цветов будет выделен путь

Вот я тут начал что то пробовать

#include <stdio.h>
#include <stdlib.h>
#include <iostream>
 
using namespace std;
 
const int M=5;//stoldez
const int N=6;//stroka
int A[6][5] =    {1,4,6,9,1,
                4,4,6,7,8,
                3,5,7,9,8,
                    2,3,2,5,9,
                1,5,7,8,9,
                0,8,6,9,9};
 
int B[6][5] =    {2,2,2,3,1,
                4,3,2,5,8,
                3,4,4,6,9,
                2,5,5,7,8,
                1,2,4,6,7,
                9,1,3,6,8};
 
 
int C[6][6]
 
 
void vivod(int a[][5],int kol)
{
    int i,j;
    for (i=0;i<kol;i++)
    {
        for (j=0;j<6;j++)
            cout<<a[i][j]<<' ';
        cout<<endl;
    
    }
 
 
 
}
 
void main()
 
{
printf("hello");
    getchar();
 
    
 
    vivod(A,N);
    vivod(B,N);
    int C[6][6];
    int D[6][6];
    C[5][5]=0;
 
 
    for (int j=4;j>0;j--)
    {
    C[5][j]=C[5][j+1];
    A[5][j];
    
    }
 
    for (int i=4;i>=0;i--)
    {
        C[i][5]=C[i+1][5]+B[5][i];
    }
 
    //S1=C[5][4]+B[4][4];
    //S2=C[4][5]+A[4][4];
    if(S1>S2)
    {
    C[4][4]=S2;
    }
    else 
    {
        C[4][4]=S1;
    }
 
    for (int i = 4;i>=0;i-- )
    {
    for ( int j=4;j>=0;j--)
    {
    
    int S1=C[i+1][j]+B[i][j];
    int S2=C[i][j+1]+A[i][j];
    if(S1>S2)
    {
     C[i][j]=S2;
    }
    else 
    {
        C[i][j]=S1;
    }
    
    }
    
    
    
    }
 
    D[0][0]=1;
    D[5][5]=1;
    int i=j=0;
    while(!D[5][4]&&D[4][5])
    {
    int sum1=a[i][j]+c[i][j+1];
    int sum2=b[i][j]+c[i+1][j+1];
if(sum==c[i][j])
{
 
D[i][j+1]=1;
j++;
}
 
else{
 
D[i+1][j]=1;
j++;
}
 
 
 
 
}
}

+ есть решенная эта задача в ручную,кто сможет помоги,пожалуйста,заранее спасибо)

[ВВС]

Дейкстра тебе в помощь