当年参加飞思卡尔自己写的双线识别算法

int zhidao_flage=0;
    int goto_cross=0;
    
    int xieshizi_among=0;//斜十字中间
    int xieshizi__cnt=0;//斜十字
    
    int start=0;//从哪里开始求平均
    int stop=0;//
    int avg=0;//黑线中点平均位置
    int flage=0,flag=0;
    int i=0,j=0,copy_j=0,among=0,up=0;
    int right[40]={0,0};//右边界记录数组---行列记录
    /*左边缘*/
    int ii=0,iii=0;
    int left_flage=0,left_flag=0;
    int left_i=0,left_j=0,left_copy_j=0,left_among=0,left_up=0;
    int left[40]={0,0}; //左边界记录数组---行列记录
    return_left_max=0;
    return_left_min=0;
    left_carry = 0;
  /*左边缘*/
  return_right_max = 0;//右边界最高点
    return_right_min = 0;//右边界最低点
    right_carry = 0;         //运行标志位
//     printf("left********");

    //左边界
    /*先找到起始点*/
           //中                   //上                      //左                       右
if(image[38][40] > thresh && image[37][40] > thresh &&image[38][39] > thresh &&image[38][41] > thresh)//所选点为白点
{
//     peedPid -> SetPoint = 20;//设置起始速度为
    if(image[38][40] > thresh)
    {
        for(left_i=40;left_i>0;left_i--)
        {
            if(image[38][left_i] < thresh)
            {
                
                left_flage = 1;              //标志位置一
                left_carry = 1;          //运行标志位置一
                left[38] = left_i;              //记录当前位置
                left_copy_j = 38;            //把最低位置传递给下面的函数
//                 left_lie[i]=copy_j;   //第i行的边界是copy_j
                return_left_min = 38; //左边界最低点
                break;
      }
        }
  }
    if(left_flage == 0)//左边上上找
    {
        for(left_j=38;left_j>16;left_j--)
        {
            if(image[left_j][1] < thresh)
            {
                if(left_j<30)
                {
                    for(ii=38;ii>20;ii--)
                    {
                        if(image[ii][40]<thresh)
                        {
                            
                            left_carry = 0;
                            return_left_max = 0;
                            return_left_min = 0;
                            goto diuxian1;
                        }
                    }
        }
//                 if(image[left_j][4] >thresh&&image[left_j][6] >thresh&&image[left_j][8] >thresh)
//                 {
//                     if(image[left_j-1][6] >thresh&&image[left_j-1][8] >thresh&&image[left_j-1][10] >thresh)
//                     {
                        left_copy_j = left_j;                    //把最低位置传递给下面的函数
//                     left_lie[i]=copy_j; //第i行的边界是copy_j
                        left_flage = 1;                    //标志位置一
                        left_carry = 1;            //运行标志位置一
                        left[left_j] = left_i;                //记录当前位置
                        return_left_min = left_j;//左边界最低点
                        break;
//           }
//         }
                
            }
        }
    }
    
    if(left_flage==1)
    {
        for(left_j = left_copy_j; left_j>1; left_j --)
        {
            left_among = left[left_j];//记录现在点的x坐标
            left_up    = left_j - 1;       //上
            if(left_up < 0) left_up = 0;
            if(*(*(image+left_up)+left_among)>thresh)//如果上面是白点
            {
                left_flag = 0;
//                 printf("111111111111");
                for(left_i = left_among; left_i >1; left_i --)//向左找黑色边缘
                {
//                     if(left_i <0)
//                     {
//                         left_i=0;
//           }
                    if(image[left_up][left_i] < thresh)//容差大于delta--找到
                    {
                        left_flag = 1;//找到边缘标志
                        left[left_up] = left_i;//记录
//                         left_lie[i]=up; //第i行的边界是up
//                         printf("22222222222");
                        break;
                    }
        }
            }
            else
            {
//                 printf("aaaaaaaaaaaaa");
                left_flag = 0;
                for(left_i = left_among; left_i<78; left_i ++)//向右找白色边缘
                {
//                     if(left_i>79)
//                     {
//                         left_i=79;
//           }
                    if(image[left_up][left_i] > thresh)//容差大于delta--找到
                    {
                        left_flag = 1;//找到边缘标志
                        left[left_up] = left_i;//记录
//                         left_lie[i]=up; //第i行的边界是up
//                         printf("bbbbbbbbbbbbb");
                        break;
                    }
        }
      }
            if(left_flag==0)
            {
//                 printf("jkfhuidasf");
                return_left_max = left_j+1;
                break;
      }
            else
            {
        return_left_max = left_j+1;//返回函数检测的最高点
//                 printf("jkfhuidasf");
      }
    }
//         printf("return_left=%d\r\n",return_left_max);
//         printf("return_left_max==%d\r\n",left[return_left_max]);
//       for(ii = 0;ii<40;ii++)
//         {
//             printf("%d",ii);
//             printf("==%d\r\n",left[ii]);
//     }
  }
diuxian1:
    /*右边界************************************************/
    if(image[38][40] > thresh)//所选点为白点
    {
        for(i=40;i<78;i++)//向右找黑点
        {
            if(image[38][i] < thresh)//找到黑点
            {
                flage = 1;              //标志位置一
                right_carry = 1;        //运行标志位置一
                right[38] = i;          //记录当前位置--第38行的边界是i
                copy_j = 38;            //把最低位置传递给下面的函数
//                 right_lie[i]=copy_j;  //第i列的边界是copy_j
                return_right_min = 38;//右边界最低点
                break;
      }
        }
  }
    if(flage == 0)//上面没找到边界
    {
        return_right_min=0;
        for(j=38;j>16;j--)//向上找10行
        {
            if(image[j][77] < thresh)//如果找到边界
            {
//                 if(image[j][74] >thresh&&image[j][71] >thresh&&image[j][68] >thresh)
//                 {
//                     if(image[j-1][72] >thresh&&image[j-1][70] >thresh&&image[j-1][68] >thresh)
//                     {
                if(j<30)
                {
                    for(ii=38;ii>20;ii--)
                    {
                        if(image[ii][40]<thresh)
                        {
//                             printf("****%d",ii);
                            right_carry = 0;
                            return_right_max = 0;
                            return_right_min = 0;
                            goto diuxian2;
                        }
                    }
        }
                        flage = 1;                        //标志位置一
                        right_carry = 1;            //运行标志位置一
                        right[j] = i;                    //记录当前位置
                        copy_j = j;                    //把最低位置传递给下面的函数
        //                 right_lie[i]=copy_j;  //第i列的边界是copy_j
                        return_right_min = j; //右边界最低点
                        break;
//                     }
//                 }
                
            }
        }
    }
    
    if(flage==1)
    {
        for(j = copy_j; j>1; j --)
        {
            among = right[j];//记录现在点的x坐标
            up    = j - 1;       //上
            if(up < 0) up = 0;
            
            if(*(*(image+up)+among)>thresh)//如果上面是白点
            {
                flag = 0;
                for(i = among; i < 78; i ++)//向右找黑色边缘
                {
//                     if(i>79)
//                     {
//                         i=79;
//           }
                    if(image[up][i] < thresh)//容差大于delta--找到
                    {
                        flag = 1;//找到边缘标志
                        right[up] = i;//记录
//                         right_lie[i]=up;  //第i列的边界是up
                        break;
                    }
        }
            }
            else
            {
                flag = 0;
                for(i = among; i > 1; i --)//向左找白色边缘
                {
//                     if(i<0)
//                     {
//                         i=0;
//           }
                    if(image[up][i] > thresh)//容差大于delta--找到
                    {
                        flag = 1;//找到边缘标志
                        right[up] = i;//记录
//                         right_lie[i]=up;  //第i列的边界是up
                        break;
                    }
        }
      }
            if(flag==0)
            {
                return_right_max = j+1;//返回函数检测的最高点
//                 printf("j==%d\r\n",j);
                break;
      }
            else
            {
        return_right_max = j+1;//返回函数检测的最高点
//                 printf("j==%d\r\n",j);
      }
    }
//         printf("return_right_max==%d\r\n",return_right_max);
//         printf("return_right_max==%d\r\n",right[return_right_max]);
//         for(ii = 0;ii<40;ii++)
//         {
//             printf("%d",ii);
//             printf("==%d\r\n",right[ii]);
//     }
  }
    diuxian2: