Scribd Logo
Încărcați

Bine ați venit la Scribd!

  • 夹方块

    Încărcat de

    wuxingjun
    5 vizualizări2 pagini
    夹方块

    Drepturi de autor

    © © All Rights Reserved

    Formate disponibile

    TXT, PDF, TXT sau citiți online pe Scribd

    Vi se pare util acest document?

    Este necorespunzător acest conținut?

    Raportați acest document
    夹方块

    Drepturi de autor:

    © All Rights Reserved
    Descărcați ca TXT, PDF, TXT sau citiți online pe Scribd
    Indicator pentru conținut neadecvat
    5 vizualizări2 pagini

    夹方块

    Încărcat de

    wuxingjun
    夹方块

    Drepturi de autor:

    © All Rights Reserved
    Descărcați ca TXT, PDF, TXT sau citiți online pe Scribd
    Indicator pentru conținut neadecvat
    din 2

    #include "Function.

    h" //
    #include "ColSensor.h" //
    #include "Track.h" //
    #include "Car.h" //
    #include "ColQueue.h" //
    #include "Servo.h"
    void CatchWXJ(int n){
    int s10,s11,s12,s13; //1
    int s20,s21,s22;//2
    int s30,s31,s32,s33; //3130155180
    int s3;
    s10=90;s20=90;s30=180; //90,90,180
    //
    s11 = 115; s12 = 88; s13= 95;
    s21 = 140; s22 = 110;
    s31 = 130; s32 = 155; s33= 180;

    //1-33
    switch (n){
    case 1:s3 = s31; break;
    case 2:s3 = s32; break;
    case 3:s3 = s33; break;
    default:return; break;
    }
    myservo1.attach(A0); myservo2.attach(12); myservo3.attach(7);
    myservo1.write(s10); myservo2.write(s20); myservo3.write(s30); //
    delay(300);
    ServoMove(180,0,3); //
    delay(1000);
    ServoMove(s10,s11,1);//
    delay(1000);
    ServoMove(90,s21,2);//
    delay(1000);
    ServoMove(s11,s12,1);//
    delay(1000);
    ServoMove(s21,90,2);//
    delay(1000);
    ServoMove(0,s3,3);//
    delay(1000);
    ServoMove(90,s22,2);//
    delay(1000);
    ServoMove(s12,s13,1);//
    delay(1000);
    ServoMove(s22,90,2);//
    delay(1000);
    ServoMove(s3,s30,3);ServoMove(s13,s10,1);//

    myservo1.detach(); myservo2.detach(); myservo3.detach(); //


    Plus(); //

    void DOWNWXJ(int n){

    int s10,s11, s12,s13; //1


    int s20,s21, s22;//2
    int s30,s31,s32,s33; //3130155180
    int s3;
    s10=90;s20=90;s30=180; //90,90,180
    //

    s11 = 100; s12 = 88; s13= 95;


    s21 = 110; s22 = 130;
    s31 = 130; s32 = 155; s33= 180;

    //1-33
    switch (n){
    case 1:s3 = s31; break;
    case 2:s3 = s32; break;
    case 3:s3 = s33; break;
    default:return; break;
    }
    myservo1.attach(A0); myservo2.attach(12); myservo3.attach(7);
    myservo1.write(s10); myservo2.write(s20); myservo3.write(s30); //
    delay(300);
    ServoMove(180,s3,3); //
    delay(1000);
    ServoMove(s10,s11,1);//
    delay(1000);
    ServoMove(90,s21,2);//
    delay(1000);
    ServoMove(s11,s12,1);//
    delay(1000);
    ServoMove(s21,90,2);//
    delay(1000);
    ServoMove(s3,90,3);//
    delay(1000);
    ServoMove(90,s22,2);//
    delay(1000);
    ServoMove(s12,s13,1);//
    delay(1000);
    ServoMove(s22,90,2);//
    delay(1000);
    ServoMove(90,s30,3);ServoMove(s13,s10,1);//
    myservo1.detach(); myservo2.detach(); myservo3.detach(); //
    }
    void setup(){
    //
    mycar.Mode();
    //
    mycar.Infer(1,0);
    //
    mysensor.Mode();
    //
    Ready();
    //Serial.begin(9600);
    }
    void loop(){
    delay(3000);
    CatchWXJ(1);
    delay(3000);
    CatchWXJ(2);
    delay(3000);
    CatchWXJ(3);
    delay(3000);
    DOWNWXJ(1);
    delay(3000);
    DOWNWXJ(2);
    delay(3000);
    DOWNWXJ(3);
    delay(500);
    }

    S-ar putea să vă placă și