Помогите реализовать метод Форда Фалкерсона

[Clockgen]

Привет всем,помогите кто-нибудь реализовать это на паскале,ну просто намертво не хочет у меня находить пути,и делать сравнения потока с пропускной способностью,скачал реализацию на Делфи и С++ ничего не помогло,прошу помогите.

[ОДИНОЧЕСТВО В СЕТИ]

//(C) автор:  Igor Kvasov
{поиск максимального потока методом Форда-Фалкерсона;
для поиска дополняющего пути используется поиск в ширину}
const
  maxn = 1000;
  infinity = maxlongint;
var
  n,m,vin,vout,i,u,v,w,head,tail,ans:longint;
  ne,p,flow:array[1..maxn]of longint;
  e,c,f:array[1..maxn,1..maxn]of longint;
  q:array[0..maxn]of longint;

begin
  read(n,m,vin,vout);
  for i:=1 to m do begin
    read(u,v,w);
    if c[v,u]=0 then begin
      inc(ne[u]); e[u,ne[u]]:=v;
      inc(ne[v]); e[v,ne[v]]:=u;
    end;
    c[u,v]:=w;
  end;
  repeat
    p[vout]:=-1;
    fillchar(flow,sizeof(flow),0);
    flow[vin]:=infinity;
    head:=0; tail:=1; Q[0]:=vin;
    while head<tail do begin
      u:=Q[head]; inc(head);
      for i:=1 to ne[u] do begin
        v:=e[u,i];
        if (c[u,v]-f[u,v]>0)and(flow[v]=0) then begin
          Q[tail]:=v; inc(tail);
          p[v]:=u;
          if c[u,v]-f[u,v]<flow[u] then flow[v]:=c[u,v]-f[u,v]
                                   else flow[v]:=flow[u];
          if v=vout then break;
        end;
      end;
    end;
    if p[vout]=-1 then break;
    u:=vout;
    while u<>vin do begin
      f[p[u],u]:=f[p[u],u]+flow[vout];
      u:=p[u];
    end;
    ans:=ans+flow[vout];
  until false;
  write(ans);
end.

[Clockgen]

Хороший код но считает он не правильно,или подскажи какими параметрами его нужно заполнять при выполнении?
Почему не правильно считает,потому что,когда у меня имеется 4 вершины получается матрица 4х4 где 1 вершина источник,а 4-я сток и получается у меня матрица:
1 2 3 4
1 0 10 10 0
2 0 0 1 10
3 0 0 0 10
4 0 0 0 0

По правилу в основной диагонали матрицы не может быть числа(Дискретная математика),и при вводе этой матрицы программа выдает мне в ответе 5,хотя ответ должен быть 20,что надо сделать?как надо исправить код,чтобы ответ был именно 20?

[Mastdrak]

Представь пожалуйста код на С++, уж больно хочется на него взглянуть