Scribd Logo
Загрузить

Добро пожаловать в Scribd!

  • 夹方块最后代码过几天再调试

    Загружено:

    wuxingjun
    7 просмотров3 страницы
    夹方块最后代码

    Авторское право

    © © All Rights Reserved

    Доступные форматы

    TXT, PDF, TXT или читайте онлайн в Scribd

    Этот документ был вам полезен?

    Это неприемлемый материал?

    Пожаловаться на этот документ
    夹方块最后代码

    Авторское право:

    © All Rights Reserved
    Скачайте в формате TXT, PDF, TXT или читайте онлайн в Scribd
    Отметить как неприемлемый контент
    7 просмотров3 страницы

    夹方块最后代码过几天再调试

    Загружено:

    wuxingjun
    夹方块最后代码

    Авторское право:

    © All Rights Reserved
    Скачайте в формате TXT, PDF, TXT или читайте онлайн в Scribd
    Отметить как неприемлемый контент
    из 3

    //11.

    26day21:24
    #include "Function.h" //
    #include "ColSensor.h" //
    #include "Track.h" //
    #include "Car.h" //
    #include "ColQueue.h" //
    #include "Servo.h"
    int RotPos;//3

    //
    void BeginCatch(){
    myservo1.attach(A0,510,2280); myservo2.attach(12,510,2280); myservo3.att
    ach(7,510,2280);
    myservo1.writeMicroseconds(map(90,0,200,510,2280));
    delay(2000);
    myservo2.writeMicroseconds(map(90,0,200,510,2280));
    delay(2000);
    myservo3.writeMicroseconds(map(180,0,200,510,2280)); //
    delay(2000);
    //90,90,180
    myservo1.detach(); myservo2.detach(); myservo3.detach(); //
    RotPos=180;
    }
    void AfterDown(){
    myservo1.attach(A0,510,2280); myservo2.attach(12,510,2280); myservo3.att
    ach(7,510,2280);
    myservo1.writeMicroseconds(map(90,0,200,510,2280));
    delay(2000);
    myservo2.writeMicroseconds(map(90,0,200,510,2280));
    delay(2000);
    //90,90,180
    ServoMove(RotPos,180,3);
    myservo1.detach(); myservo2.detach(); myservo3.detach(); //
    }
    void CatchWXJ(int n){
    int s10,s11,s12,s13; //1 s11s12s13
    int s20,s21,s22;//2
    int s30,s31,s32,s33; //3130155180
    int s3;
    s10=90;s20=90;s30=180; //90,90,180
    //
    s11 = 125; s12 = 88; s13= 95;
    s21 = 140; s22 = 105;
    s31 = 140; s32 = 160; s33= 180;
    //s31 = 160; s32 = 180; s33= 195;
    //1-33
    switch (n){
    case 1:s3 = s31; break;
    case 2:s3 = s32; break;
    case 3:s3 = s33; break;
    default:return; break;
    }
    //180200,
    myservo1.attach(A0,510,2280); myservo2.attach(12,510,2280); myservo3.att
    ach(7,510,2280);
    //1,23
    delay(300);

    ServoMove(RotPos,0,3); //
    delay(1000);
    ServoMove(s10,s11,1);//:s11
    delay(1000);
    ServoMove(90,s21,2);//
    delay(1000);
    ServoMove(s11,s13,1);//
    delay(1000);
    ServoMove(s21,s21-5,2);//
    delay(1000);
    ServoMove(s13,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);
    RotPos=s3;
    //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 = 140; s32 = 160; s33= 180;
    //s31 = 160; s32 = 180; s33= 195;

    //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,510,2280); myservo2.attach(12,510,2280); myservo3.att
    ach(7,510,2280);
    //
    myservo1.write(s10); myservo2.write(s20); myservo3.write(s30); //
    delay(300);
    ServoMove(RotPos,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);
    RotPos=90;
    ServoMove(s13,s10,1);//
    myservo1.detach(); myservo2.detach(); myservo3.detach(); //

    void setup(){
    //
    mycar.Mode();
    //
    mycar.Infer(1,0);
    //
    mysensor.Mode();
    //
    Ready();
    //Serial.begin(9600);
    BeginCatch();
    }
    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(3500);
    AfterDown();
    }

    Вам также может понравиться