Ошибка в алгоритме

for(int i=0; i<X1.size();i++)
                {   pytX.clear();
                    pytY.clear();
                    FN.clear();
                    unsigned int LG=0;
                    unsigned int LG2=0;
                    RESH.push_back(vector<double>());
                    FN.push_back(1);
                    pytX.push_back(X1[i]);
                    pytY.push_back(Y1[i]);
                    bool bo=true;
while(bo==true)
{
if(pytX.back()==A.back()&&FN.back()==1)
        FN.back()=2;
if(pytY.back()==B.back()&&FN.back()==2)
        FN.back()=3;
if(pytX.back()==A[0]&&FN.back()==3)
    FN.back()=4;
if(pytY.back()==B[0]&&FN.back()==4)
        FN.back()=5;
if(FN.back()==1)
        for(int k=0;k<A.size()-1;k++)
                if(A[k]==pytX.back())
                                    {   
                                        pytX.push_back(A[k+1]); 
                                        pytY.push_back(pytY.back());     
                                        FN.push_back(1);
                                    }
if(FN.back()==2)
        for(int k=0;k<B.size()-1;k++)
                    if(B[k]==pytY.back())
                                    {                                       
                                        pytY.push_back(B[k+1]);
                                        pytX.push_back(pytX.back());
                                        FN.push_back(1);
                                    }
                                                
if(FN.back()==3)
        for(int k=1;k<A.size();k++)
                    if(A[k]==pytX.back())
                                    {   
                                        pytX.push_back(A[k-1]);
                                        pytY.push_back(pytY.back());
                                        FN.push_back(1);
                                    }
if(FN.back()==4)
            for(int k=1;k<B.size();k++)
                    if(B[k]==pytY.back())
                                {                                       
                                        pytY.push_back(B[k-1]);
                                        pytX.push_back(pytX.back());
                                        FN.push_back(1);
                                }
for(int jj=0;jj<pytX.size()-1;jj++) 
            if(pytX[jj]==pytX.back()&&pytY[jj]==pytY.back())
                        {
                            FN.pop_back();
                            pytX.pop_back();
                            pytY.pop_back();
                            FN.back()++;
                        }
if(FN.back()>4)
            {
                if(FN.size()==1)
                        bo=false;
                else 
                        FN.pop_back();
                        pytX.pop_back();
                        pytY.pop_back();
                        FN.back()++;
            }
else if(pytX.back()==xx&&pytY.back()==yy)//+условия решения
                        {
                        LG=0;
                        for(int z=0;z<pytX.size()-1;z++)
                            LG+=fabs((pytX[z]-pytX[z+1]+pytY[z]-pytY[z+1]));
                        if (LG<LG2||LG2==0) //нашли решение
                            {
                            LG2=LG;
                            resh.clear();
                            for(int ii=0; ii<pytX.size();ii++)
                                {
                                resh.push_back(pytX[ii]);
                                resh.push_back(pytY[ii]);
                                }   
                            }
                        FN.pop_back();
                        FN.back()++;
                        }
}
for(int j=0;j<resh.size();j++)
        RESH[i].push_back(resh[j]);
}