久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

標題: 教育機器人比賽程序 [打印本頁]

作者: 八叛徒    時間: 2016-9-26 11:52
標題: 教育機器人比賽程序

void dao_w()         //推到白,紅,黑區域的定位程序
{        
                while((!P14_state())||(!P16_state()))
        {   
                //中線控制

//大右偏判斷

                  if((P21_state()&&(!P22_state())&&(!P23_state())&&(!P24_state())))
{
                        motor_motion(1500, 1350,1);           //左轉修正
                }
                //機器人小右偏判斷   x 1 0 x  
        else   if((P22_state()&&(!P23_state()))||(P21_state()&&(!P22_state())&&(!P23_state())&&(!P24_state())))
                {
                        motor_motion(1550, 1400,1);           //左轉修正
                }

         
//大左偏判斷
     else if(((!P21_state())&&(!P22_state())&&(!P23_state())&&P24_state()))
{
                        motor_motion(1650, 1500,1);           //右轉修正
                }
                //機器人小左偏判斷   x 0 1 x   或   0 0 0 1
                else if(((!P22_state())&&P23_state())||((!P21_state())&&(!P22_state())&&(!P23_state())&&P24_state()))
                {
                        motor_motion(1600, 1450,1);           //右轉修正
                }

                else if(P21_state()&&P22_state()&&P23_state()&&P24_state())                         //到十字路口, 1 1 1 1
                {
                           break;                                   //退出循環,下一個任務
                }                  
        else                                                  //其他情況
                {
                        motor_motion(LEFT_QX, 1400, 1);          //前進        1584, 1420, 1         1683, 1320, 1
                }
                }          
           }
void dao_lan()                 //         推到藍色的定位
{        
        while(!P14_state())
        {   
                //中線控制

//大右偏判斷

                  if((P21_state()&&(!P22_state())&&(!P23_state())&&(!P24_state())))
{
                        motor_motion(1500, 1350,1);           //左轉修正
                }
                //機器人小右偏判斷   x 1 0 x  
        else   if((P22_state()&&(!P23_state()))||(P21_state()&&(!P22_state())&&(!P23_state())&&(!P24_state())))
                {
                        motor_motion(1550, 1400,1);           //左轉修正
                }

         
//大左偏判斷
     else if(((!P21_state())&&(!P22_state())&&(!P23_state())&&P24_state()))
{
                        motor_motion(1650, 1500,1);           //右轉修正
                }
                //機器人小左偏判斷   x 0 1 x   或   0 0 0 1
                else if(((!P22_state())&&P23_state())||((!P21_state())&&(!P22_state())&&(!P23_state())&&P24_state()))
                {
                        motor_motion(1600, 1450,1);           //右轉修正
                }

                else if(P21_state()&&P22_state()&&P23_state()&&P24_state())                         //到十字路口, 1 1 1 1
                {
                           break;                                   //退出循環,下一個任務
                }                  
        else                                                  //其他情況
                {
                        motor_motion(LEFT_QX, 1400, 1);          //前進        1584, 1420, 1         1683, 1320, 1
                }
                }          
           }

void dao_huang()                  //推到黃色區域的定位
{        
        while(!P16_state())
        {   
                //中線控制

//大右偏判斷

                  if((P21_state()&&(!P22_state())&&(!P23_state())&&(!P24_state())))
{
                        motor_motion(1500, 1350,1);           //左轉修正
                }
                //機器人小右偏判斷   x 1 0 x  
        else   if((P22_state()&&(!P23_state()))||(P21_state()&&(!P22_state())&&(!P23_state())&&(!P24_state())))
                {
                        motor_motion(1550, 1400,1);           //左轉修正
                }

         
//大左偏判斷
     else if(((!P21_state())&&(!P22_state())&&(!P23_state())&&P24_state()))
{
                        motor_motion(1650, 1500,1);           //右轉修正
                }
                //機器人小左偏判斷   x 0 1 x   或   0 0 0 1
                else if(((!P22_state())&&P23_state())||((!P21_state())&&(!P22_state())&&(!P23_state())&&P24_state()))
                {
                        motor_motion(1600, 1450,1);           //右轉修正
                }

                else if(P21_state()&&P22_state()&&P23_state()&&P24_state())                         //到十字路口, 1 1 1 1
                {
                           break;                                   //退出循環,下一個任務
                }                  
        else                                                  //其他情況
                {
                        motor_motion(LEFT_QX, 1415, 1);          //前進        1584, 1420, 1         1683, 1320, 1
                }
                }          
           }


//QQQQQQQQQQQQQQQQQQQQQQQQQQQQQQQQQQQQQQQQ////////////////
//從起點到A,B,C,D,E
void Q_A()
{
        to_shizilukou1();
        motor_motion(1620,1400,20);
        to_shizilukou2();
        motor_motion(LEFT_QX,1400,6) ; //第二十字路樓口到A點前
        fan90_L();
        delay_nms(10);
        to_zou(70);
        delay_nms(100);
        //motor_motion(LEFT_QX,1400,20);        //前行
}
void Q_B()
{
        to_shizilukou1();
           motor_motion(1620,1400,20);
        to_shizilukou2();       
        motor_motion(LEFT_QX,1400,6);        //第二十字路樓口到B點前
        fan45_L();
        delay_nms(10);
        to_zou(70);
        delay_nms(100);          
        motor_motion(LEFT_QX,1400,30);        //前行       
}
void Q_C()
{         
        to_shizilukou1();
           motor_motion(LEFT_QX,1400,20);
        to_shizilukou2();
        to_zou(70);                          //第二十字路樓口到C點前
        delay_nms(100);
}
void Q_D()
{
        to_shizilukou1();
           motor_motion(1620,1400,20);
        to_shizilukou2();
        motor_motion(LEFT_QX,1400,7) ;                //第二十字路樓口到D點前
        fan45_R();
        delay_nms(10);
        to_zou(70);          
        motor_motion(LEFT_QX,1400,30);        //前行       
}
void Q_E()
{
        to_shizilukou1();
           motor_motion(1620,1400,20);
        to_shizilukou2();
        motor_motion(LEFT_QX,1400,7) ;                //第二十字路樓口到E點前
        fan90_R();
        delay_nms(10);
        to_zou(70);          
        motor_motion(LEFT_QX,1400,30);        //前行       
}


//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
//        將黃色物塊推到黃色靶心后到B,C,D,E,
void Huang_to_B()
{
        daotui();
        fan180();
        to_shizilukou2();
        motor_motion(LEFT_QX, 1400,13);
        fan135_L();
        delay_nms(10);
        to_zou(70);
}
void Huang_to_C()//90ok
{         
     daotui();
     fan180();
     to_shizilukou2();
     motor_motion(LEFT_QX, 1400,12);
         fan90_L();
         delay_nms(10);
         to_zou(70);                          //
}

void Huang_to_D()//45ok
{
    daotui();
    fan180();
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,13);
        fan45_L();
        delay_nms(10);
        to_zou(70);
       
}

void Huang_to_E()//180ok
{
    daotui();
    fan180();
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,33);
        to_zou(70);
}
//從黃色靶心回到第二  十字路口車頭正對起點
void Huang_to_shizilukou()
{
        daotui();
    fan180();
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,12);
        fan90_L();
        delay_nms(10);
        to_zou(70);
        fan180();
        delay_nms(10);
        to_shizilukou2();
        motor_motion(LEFT_QX, 1400,14);
        motor_motion(1600, 1600,1);                //往右偏點
}
//將A點的物快推到各靶心
void A_huang()
{
        dao_huang();
}
void A_bai()
{
        fan180();
        delay_nms(10);
        to_shizilukou2();
        motor_motion(LEFT_QX, 1400,13);
        fan135_L();
        delay_nms(10);
        to_zou(70);
        dao_w();
}
void A_hong()//90ok
{         
     //to_zou(50);
     fan180();
         delay_nms(10);
     to_shizilukou2();
     motor_motion(LEFT_QX, 1400,12);
         fan90_L();
         delay_nms(10);
         to_zou(70);
         dao_w();                          //
}
                                                                                     
void A_hei()//45ok
{
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,13);
        fan45_L();
        delay_nms(10);
        to_zou(60);
        dao_w();


}

void A_lan()//180ok
{
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,30);
        to_zou(60);
        dao_lan();


}

//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
//將物塊推到白色區域后,到A,C,D,E點
void Bai_to_A()//135ok
{
    daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,9);
        fan135_R();
        delay_nms(10);
        to_zou(60);
}
void Bai_to_C()
{       
    daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,15);
        fan135_L();
        delay_nms(10);
        to_zou(60);
}

void Bai_to_D()//90ok
{
    daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,13);
        fan90_L();
        delay_nms(10);
        to_zou(60);
}

void Bai_to_E()//45ok
{
    daotui();;
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,20);
        fan45_L();
        delay_nms(10);
        to_zou(60);
}
//BBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBB///////////////

void B_huang()//135ok
{
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,10);
        fan135_R();
        delay_nms(10);
        to_zou(60);
        dao_huang();

}
void B_bai()
{       
  dao_w();

  }

void B_hong()//135ok
{
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,15);
        fan135_L();
        delay_nms(10);
        to_zou(60);
        dao_w();


}

void B_hei()//90ok
{
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,13);
        fan90_L();
        delay_nms(10);
        to_zou(60);
        dao_w();


}

void B_lan()//45ok
{
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,20);
        fan45_L();
        delay_nms(10);
        to_zou(60);
        dao_lan();
}
//從B的白色區域回到第二十字路口車頭正對起點
void Bai_to_shizilukou()                                                 
{   
        daotui();
        fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,15);
        fan135_L();
        delay_nms(10);
        to_zou(60);
    fan180();
    delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,14);
        motor_motion(1600, 1600,1);                //往右偏點
   

}

//**************+++++++++++++++++++++++++++++++++=************************88
//從紅色區域去到每條路上的點
void Hong_to_A()//90ok
{
    daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,10);
        fan90_R();
        delay_nms(10);
        to_zou(60);
}

void Hong_to_B()//135ok
{
    daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,5);
        fan135_R();
        delay_nms(10);
        to_zou(60);
}
void Hong_to_D()
{       
        daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,13);
    fan135_L();
        delay_nms(10);
        to_zou(60);
}



void Hong_to_E()//90ok
{         
    daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,11);
        fan90_L();
        delay_nms(10);
        to_zou(60);
}
//CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC//////////////
void C_huang()//90ok
{
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,10);
        fan90_R();
        delay_nms(10);
        to_zou(60);
        dao_huang();
}

void C_bai()//135ok
{
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,5);
        fan135_R();
        delay_nms(10);
        to_zou(60);
        dao_w();


}
void C_hong()
{       
        dao_w();

  }

void C_hei()//135ok
{         
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,13);
    fan135_L();
        delay_nms(10);
        to_zou(60);
        dao_w();

         
}

void C_lan()//90ok
{         
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,11);
        fan90_L();
        delay_nms(10);
        to_zou(60);
        dao_lan();
}
//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
//從C的紅色區域回到第二十字路口車頭正對起點
void Hong_to_shizilukou()                                                 
{
   daotui();
   fan180();  
   delay_nms(10);
   to_shizilukou2();
   motor_motion(LEFT_QX, 1400,14);
        motor_motion(1600, 1600,1);                //往右偏點

}
//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
//將黑色靶心到A,B,C,E點
void Hei_to_A()//45ok
{          
     daotui;
     fan180();
         delay_nms(10);
     to_shizilukou2();
     motor_motion(LEFT_QX, 1400,11);
         fan45_R();
         delay_nms(10);
         to_zou(60);
}


void Hei_to_B()//90ok
{
     daotui();
     fan180();
         delay_nms(10);
     to_shizilukou2();
         motor_motion(LEFT_QX, 1400,10);
         fan90_R();
         delay_nms(10);
         to_zou(60);
}

void Hei_to_C()//135ok
{
    daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,11);
        fan135_R();
        delay_nms(10);
        to_zou(60);
}

void Hei_to_E()//135ok
{         
     daotui();
     fan180();
         delay_nms(10);
     to_shizilukou2();
         motor_motion(LEFT_QX, 1400,15);
         fan135_L();
         delay_nms(10);
         to_zou(60);
}
//DDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDD//////////
void D_huang()//45ok
{          
     //to_zou(50);
     fan180();
         delay_nms(10);
     to_shizilukou2();
     motor_motion(LEFT_QX, 1400,11);
         fan45_R();
         delay_nms(10);
         to_zou(60);
         dao_huang();
}


void D_bai()//90ok
{
     //to_zou(50);
     fan180();
         delay_nms(10);
     to_shizilukou2();
         motor_motion(LEFT_QX, 1400,10);
         fan90_R();
         delay_nms(10);
         to_zou(60);
         dao_w();

         
}

void D_hong()//135ok
{
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,11);
        fan135_R();
        delay_nms(10);
        to_zou(60);
        dao_w();
}

void D_hei()
{       
        dao_w();
}

void D_lan()//135ok
{         
     //to_zou(50);
     fan180();
         delay_nms(10);
     to_shizilukou2();
         motor_motion(LEFT_QX, 1400,11);
         fan135_L();
         delay_nms(10);
         to_zou(60);
         dao_lan();
         motor_motion(LEFT_QX, 1400,2);
}
//從D的黑色區域回到第二十字路口車頭正對起點
void Hei_to_shizilukou()                                                 
{
        daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,11);
        fan135_R();
        delay_nms(10);
        to_zou(70);
        fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,14);
        motor_motion(1600, 1600,1);                //往右偏點
}
//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
//從藍色靶心到A,B,C,D點
void Lan_to_A()//180ok
{
    daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,12);
        to_zou(60);
}

void Lan_to_B()//45ok
{
           daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,11);
    fan45_R();
        delay_nms(10);
        to_zou(60);                            
}

void Lan_to_C()//90ok
{
    daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,6);
        fan90_R();
        delay_nms(10);
        to_zou(60);  
}

void Lan_to_D()//135ok
{
    daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,10);
        fan135_R();
        delay_nms(10);
        to_zou(60);
        dao_w();
  
}
//EEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEEE///////////////
void E_huang()//180ok
{
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,12);
        to_zou(60);
    dao_huang();
}

void E_bai()//45ok
{
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,11);
    fan45_R();
        delay_nms(10);
        to_zou(60);
        dao_w();
  

}

void E_hong()//90ok
{
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,6);
        fan90_R();
        delay_nms(10);
        to_zou(60);
        dao_w();
  

}

void E_hei()//135ok
{
    //to_zou(50);
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,10);
        fan135_R();
        delay_nms(10);
        to_zou(60);
        dao_w();
  
}
void E_lan()
{       
        dao_lan();
}
//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
//從E的藍色區域回到第二十字路口車頭正對起點
void Lan_to_shizilukou()                                                 
{         
        daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,6);
        fan90_R();
        delay_nms(10);
        to_zou(70);
        motor_motion(1400, 1250,52);        // fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,14);
        motor_motion(1600, 1600,1);                //往右偏點
}

//^%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*************************%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%************************
//借道代碼//借道代碼//借道代碼//借道代碼//借道代碼////
////然后將小車走回第二十字鹿樓口///////////////
void A_hui()
{   //to_zou(45);
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,12);
        fan90_R();
        delay_nms(10);
        to_zou(70);
        daotui();
        fan180();
        delay_nms(10);
        to_shizilukou2();
}

void B_hui()
{   //to_zou(45);
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,8);
        fan45_R();
        delay_nms(10);
    to_zou(70);
        daotui();
        fan180();
        delay_nms(10);
        to_shizilukou2();
}
void C_hui()
{
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,10);
        to_zou(70);
        daotui();
        fan180();
        delay_nms(10);
        to_shizilukou2();
}
void D_hui()
{   //to_zou(45);
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,10);
        fan45_L();
        delay_nms(10);
    to_zou(70);
        daotui();
        fan180();
        delay_nms(10);
        to_shizilukou2();
}

void E_hui()
{   //to_zou(45);
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,6);
        fan90_L();
        delay_nms(10);
    to_zou(70);
        daotui();
        fan180();
        delay_nms(10);
        to_shizilukou2();
}
//%%%%%%%%%%%%^****************************************%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
//*****從各靶心到借道的位置拿回物快
void Huang_hui()
{   
        daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,12);
        fan90_R();
        delay_nms(10);
        to_zou(70);
        fan180();
        delay_nms(10);
        to_shizilukou2();
}

void Bai_hui()
{   
        daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,8);
        fan45_R();
        delay_nms(10);
    to_zou(70);
        fan180();
        delay_nms(10);
        to_shizilukou2();
}
void Hong_hui()
{       
        daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
        motor_motion(LEFT_QX, 1400,10);
        to_zou(70);
        fan180();
        delay_nms(10);
        to_shizilukou2();
}
void Hei_hui()
{   

        daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,10);
        fan45_L();
        delay_nms(10);
    to_zou(70);
        fan180();
        delay_nms(10);
        to_shizilukou2();
}

void Lan_hui()
{   
        daotui();
    fan180();
        delay_nms(10);
    to_shizilukou2();
    motor_motion(LEFT_QX, 1400,6);
        fan90_L();
        delay_nms(10);
    to_zou(70);
        fan180();
        delay_nms(10);
        to_shizilukou2();
}
//*******************************************************************************%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%**************
//從十字路去推F,G,H,I,推物快回到第二個十字路口
void  shizilukou_to_F()
{
        fan60_L();
        motor_motion(LEFT_QX, 1400,80);
        fan180();                   //掉頭
        delay_nms(10);
        fan30_L();               
        to_shizilukou2();
        motor_motion(LEFT_QX, 1400,7);
        fan90_R();
        to_shizilukou2();
}
void shizilukou_to_G()
{
    fan30_L();
        motor_motion(LEFT_QX, 1400,80);
        fan180();                   //掉頭
        fan60_L();               
        to_shizilukou2();
        motor_motion(LEFT_QX, 1400,5);
        fan90_R();
        to_shizilukou2();
}
void  shizilukou_to_H()
{
        fan30_R();
        motor_motion(LEFT_QX, 1400,80);
        fan180();                   //掉頭
        fan30_R();               
        to_shizilukou2();
        motor_motion(LEFT_QX, 1400,5);
        fan90_L();
        to_shizilukou2();
}
void  shizilukou_to_I()
{
        fan60_R();
        motor_motion(LEFT_QX, 1400,70);
        fan180();                   //掉頭
        fan60_R();               
        to_shizilukou2();
        motor_motion(LEFT_QX, 1400,7);
        fan90_L();
        to_shizilukou2();
}
//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*************************
//十字路口推到靶心
void shizilukou_huang()
{
        motor_motion(LEFT_QX,1400,10);
        fan90_L();
        to_zou(60);
        dao_lan();
}
void shizilukou_bai()
{
        motor_motion(LEFT_QX,1400,10);
        fan45_L();
        to_zou(60);
        dao_w();
}
void shizilukou_hong()
{
        motor_motion(LEFT_QX,1400,10);
        to_zou(60);
        dao_w();       
}
void shizilukou_hei()
{
        motor_motion(LEFT_QX,1400,10);
        fan45_R();
        to_zou(60);
        dao_w();
}
void shizilukou_lan()
{
        motor_motion(LEFT_QX,1400,10);
        fan90_R();
        to_zou(60);
        dao_lan();
}
//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
//****&*&*&*&*^&*%*^$十字路口去A,B,C,D,E點
void shizilukou_A()
{
        motor_motion(LEFT_QX,1400,10);
        fan90_L();
        to_zou(60);
}
void shizilukou_B()
{
        motor_motion(LEFT_QX,1400,10);
        fan45_L();
        to_zou(60);
}
void shizilukou_C()
{
        motor_motion(LEFT_QX,1400,10);
        to_zou(60);       
}
void shizilukou_D()
{
        motor_motion(LEFT_QX,1400,10);
        fan45_R();
        to_zou(60);
}
void shizilukou_E()
{
        motor_motion(LEFT_QX,1400,10);
        fan90_R();
        to_zou(60);




歡迎光臨 (http://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板: 亚洲国产视频一区二区 | 亚洲精品一区二区 | 日本黄色一级片视频 | hsck成人网| 亚洲午夜久久久 | 午夜影院在线免费观看视频 | 午夜91| 97国产精品视频人人做人人爱 | 中文字幕在线电影观看 | 三级av在线| 国产91视频免费 | 久久久久久久国产 | 国产精品视频网 | 污污的网站在线观看 | av一级久久| 欧美色欧美亚洲另类七区 | 91色啪| 日韩精品在线一区 | 国产精品久久久久久久久免费丝袜 | 国产一区二区不卡 | 色婷婷亚洲国产女人的天堂 | 1区2区3区视频 | 成人av一区二区三区 | 日韩 欧美 二区 | 成人自拍视频网站 | 毛片网站在线观看 | 九色视频网站 | 亚洲成人三区 | 久久久久久久久中文字幕 | 欧美精品免费观看二区 | 国产大片一区 | 色免费在线视频 | 欧美成人a | 亚洲人成人一区二区在线观看 | www.欧美 | 欧美日本韩国一区二区 | 男女视频网站 | 国产丝袜一区二区三区免费视频 | 日韩一级电影免费观看 | 欧美a在线看 | 国产1区2区 |