поиск длины пути

#include <stdio.h>
#include <conio.h>
#include <memory.h>
 
#include <iostream>
 
#define MAX 10
 
typedef struct Route
{
    int* p;
    int count;
    int length;
} ROUTE;
 
using namespace std;
 
ROUTE& addtop(ROUTE* route, int top)
{
    ROUTE* rdest = new ROUTE;
    int *p = new int[MAX], pos = route->count;
    memcpy((void*)p, (void*)route->p, sizeof(int) * pos);
    p[pos] = top; rdest->p = p; rdest->count = pos+1;
 
    return *rdest;
}
 
int gettop(ROUTE* route)
{
    int len = route->count, top = 0;
    return len > 0 && ((top =
        route->p[len-1]) >= 0) ? top : -1;
}
 
bool visited(ROUTE* route, int top)
{
    for (int i = 0; route->p[i] >= 0; i++)
         if (route->p[i] == top) return true;
    return false;
}
 
const int M[MAX][MAX] = { { 0, 0, 2, 0, 0, 7, 0, 0, 0, 0 },
                          { 8, 0, 0, 0, 0, 4, 6, 0, 0, 0 },
                          { 0, 0, 0, 6, 9, 0, 0, 0, 0, 0 },
                          { 0, 0, 0, 0, 0, 0, 0, 5, 0, 5 },
                          { 0, 0, 0, 1, 0, 2, 0, 0, 0, 0 },
                          { 6, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
                          { 0, 0, 0, 0, 0, 0, 0, 0, 3, 0 },
                          { 0, 0, 0, 0, 8, 0, 4, 0, 0, 0 },
                          { 0, 0, 0, 0, 0, 0, 0, 9, 0, 7 },
                          { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 } };
 
int main()
{
    int start = 1, finish = 2;
 
    ROUTE* routes = new ROUTE[256];
    memset((void*)routes, 0x00, sizeof(ROUTE) * 256);
 
    routes[0].p = new int[MAX];
    routes[0].p[0] = start; routes[0].count = 1;
 
    for (int i = 0, r = 1; routes[i].count > 0; i++)
    {
        int top = gettop(&routes[i]);
        if (top >= 0 && top != finish)
        {
            for (int j = 0; j < MAX; j++)
                 if (M[top][j] > 0 && !visited(&routes[i],j))
                 {
                     ROUTE target = addtop(&routes[i], j);
                     if (target.p != NULL) routes[r++] = target;
                 }
        }
 
        else {
            for (int q = 0; routes[i].p[q] >= 0; q++)
                 cout << routes[i].p[q] << " ";
            
            int len = 0;
            for (int t = 1; routes[i].p[t] >= 0; t++)
                len+=M[routes[i].p[t-1]][routes[i].p[t]];
 
            routes[i].length = len;
            cout << "len = " << routes[i].length << endl;
        }
    }
 
    _getch();
 
    return 0;
}