Flooding alghorithm (Matlab)

axis ij
grid
A=[-1,-1,-1,-1,-1,-1,-1,-1,-1,-1;-1,0,-1,0,0,0,-1,-1,-1,-1;...
    -1,0,-1,0,-1,0,0,0,0,-1;-1,0,-1,-1,-1,0,-1,-1,0,-1;...
    -1,0,0,-0,-1,0,-1,0,0,-1;-1,-1,-1,0,-1,-1,-1,0,-1,-1;...
    -1,0,-1,0,0,-1,0,0,0,-1;-1,0,-1,-1,0,-1,-1,0,-1,-1;...
    -1,0,0,0,0,0,0,0,0,-1;-1,-1,-1,-1,-1,-1,-1,-1,-1,-1]
rectangle('position',[0 0 10 1],'facecolor','b','edgecolor','b')
rectangle('position',[0 9 10 1],'facecolor','b','edgecolor','b')
rectangle('position',[0 1 1 9],'facecolor','b','edgecolor','b')
rectangle('position',[9 1 1 9],'facecolor','b','edgecolor','b')
rectangle('position',[2 1 1 3],'facecolor','b','edgecolor','b')
rectangle('position',[4 2 1 4],'facecolor','b','edgecolor','b')
rectangle('position',[2 5 1 3],'facecolor','b','edgecolor','b')
rectangle('position',[5 5 1 3],'facecolor','b','edgecolor','b')
rectangle('position',[6 1 4 1],'facecolor','b','edgecolor','b')
rectangle('position',[6 3 1 3],'facecolor','b','edgecolor','b')
rectangle('position',[1 5 1 1],'facecolor','b','edgecolor','b')
rectangle('position',[3 3 1 1],'facecolor','b','edgecolor','b')
rectangle('position',[3 7 1 1],'facecolor','b','edgecolor','b')
rectangle('position',[6 7 1 1],'facecolor','b','edgecolor','b')
rectangle('position',[7 3 1 1],'facecolor','b','edgecolor','b')
rectangle('position',[8 5 1 1],'facecolor','b','edgecolor','b')
rectangle('position',[8 7 1 1],'facecolor','b','edgecolor','b')

X_start=input('Vnesi zacetno x koordinato:');
Y_start=input('Vnesi zacetno y koordinato:');

round(X_start)
round(Y_start)

if A(X_start,Y_start)==(-1)
    fprintf('\nVnesli ste neveljavno koordinato začetka! Začetek ne sme biti na robu labirinta.\n')
    X_start=input('Vnesi zacetno x koordinato:');
    Y_start=input('Vnesi zacetno y koordinato:');
end

X_finish=input('Vnesi koncno x koordinato:');
Y_finish=input('Vnesi koncno y koordinato:');

round(X_finish)
round(Y_finish)

if A(X_finish,Y_finish)==(-1)
    fprintf('\nVnesli ste neveljavno koordinato cilja! Začetek ne sme biti na robu labirinta.\n')
    X_finish=input('Vnesi zacetno x koordinato:');
    Y_finish=input('Vnesi zacetno y koordinato:');
end

if ((X_start<1)||(X_start>10))||((Y_start<1)||(Y_start>10))||((X_finish<1)||(X_finish>10))||((Y_finish<1)||(Y_finish>10))
    fprintf('\nVnesli ste neveljavno koordinato začetka oz. cilja! Koordinata mora biti celo število med 1 in 10.\n')
    X_start=input('Vnesi zacetno x koordinato:');
    Y_start=input('Vnesi zacetno y koordinato:');
    X_finish=input('Vnesi zacetno x koordinato:');
    Y_finish=input('Vnesi zacetno y koordinato:');
end

if ((X_start==X_finish)&&(Y_start==Y_finish))
    fprintf('Koordinati cilja ne smeta biti enaki koordinati začetka!')
    X_start=input('Vnesi zacetno x koordinato:');
    Y_start=input('Vnesi zacetno y koordinato:');
    X_finish=input('Vnesi zacetno x koordinato:');
    Y_finish=input('Vnesi zacetno y koordinato:');
end

rectangle('position',[Y_start-1 X_start-1 1 1],'curvature',[1,1],'facecolor','r','edgecolor','r')
rectangle('position',[Y_finish-1 X_finish-1 1 1],'curvature',[1,1],'facecolor','black','edgecolor','black')



if((A(X_start,Y_start-1))==0)
    A(X_start,(Y_start-1))=A(X_start,(Y_start-1))+1;     
end

if((A(X_start,Y_start+1))==0)
    A(X_start,(Y_start+1))=A(X_start,(Y_start+1))+1;
end

if((A(X_start-1,Y_start))==0)
    A((X_start-1),Y_start)=A((X_start-1),Y_start)+1;
end

if((A(X_start+1,Y_start))==0)
    A((X_start+1),Y_start)=A((X_start+1),Y_start)+1;
end

A(X_start,Y_start)=1000;

A(X_finish,Y_finish)=2000;


for cifra=1:40;

    [i,j]=find(A==cifra);
    
    Z=numel(i);
    
    for ind = 1 : Z;
        X=i(ind);
        Y=j(ind);

        if((A(X,Y-1))==0)
        A(X,(Y-1))=A(X,(Y-1))+cifra+1;     
        end
        if((A(X,Y+1))==0)
        A(X,(Y+1))=A(X,(Y+1))+cifra+1;
        end
        if((A(X-1,Y))==0)
        A((X-1),Y)=A((X-1),Y)+cifra+1;
        end
        if((A(X+1,Y))==0)
        A((X+1),Y)=A((X+1),Y)+cifra+1;
        end
        
        
    end
    
    if (A(X,Y)==2000);
        break;
    end
    
end


display('Konec poti')