расстояние между любыми двумя узлами в графе (на основе ребер между ними)

Question

Приведенный ниже код на c ++ должен найти расстояние между любыми двумя узлами в графе, но есть некоторая логическая ошибка, где я пытался найти, но не могу. Кажется, все идеально, но я могу сказать, что что-то не так с условием break внутри if внутри для l oop, который находится внутри while(s.!empty()).

#include<bits/stdc++.h>
#include<iostream>
using namespace std;

int find_distance(int link[100][100],int start,int dest,int n,int e)
{
    start=start-1;
    dest=dest-1;
    if(start==dest)return 0;
    int visited[100];
    int distance;
    for(int i=0;i<n;i++)
    {
        visited[i]=0;
    }
    stack<int>s;
    int k;s.push(start);
    visited[start]=1;
    bool found=false;
    int count =0;
    while(!s.empty())
    {
        k=s.top();
        int i;

        int check_point=1;
        for(i=0;i<n;i++)
        {
            if(link[k][i]==1 && visited[i]!=1)
            {
                s.push(i);
                count ++;
                check_point=0;
                if(i==dest)
                {
                    cout<<"found";
                    found=true;             
                }
            break;
            }
        }
        if(check_point==1)
        {
            s.pop();
            count--;
        }
        if(found)break;
    }
    return count;
}

int main()
{
    int n,e,a,b;
    int link[100][100];
    cout<<"enter the number of vertices and edges";
//  cin>>n>>e;
n=5;e=4;
    for(int i=0;i<n;i++)
    {
        for(int j=0;j<n;j++)
        {
            if(i==j)
            link[i][j]=0;
            else
            link[i][j]=INT_MAX;
            cout<<link[i][j]<<"             ";
        }
        cout<<endl;
    }
    int input[4][2]={{1,2},{1,3},{2,4},{2,5}};
    for(int i=0;i<e;i++)
    {
        a=input[i][0];
        b=input[i][1];
        link[a-1][b-1]=1;
        link[b-1][a-1]=1;
    }
    for(int i=0;i<n;i++)
    {
        for(int j=0;j<n;j++)
        {
            cout<<link[i][j]<<"              ";
        }
        cout<<endl;
    }
    while(true) {
        cout<<endl<<"enter the starting point .. ";
        int start;
        cin>>start;
        int dest;
        cout<<endl<<"enter the destination point .. ";
        cin>>dest;

        int distance = find_distance(link,start,dest,n,e);
        cout<<endl<<"distance is "<<distance;   
    }
    return 0;
}