AIoTs  Advanced 02 Code

程式碼

int t= 2;//t會影響轉速，t越小轉越快，太小會轉不動

int gate_P = A0;

int button_P2 = 2;

int button_P = 3;

int button;

int button2;

int gate;

void setup() {

  pinMode(button_P,INPUT_PULLUP);

  pinMode(button_P2,INPUT_PULLUP);

  pinMode(gate_P,INPUT);

  pinMode(8,OUTPUT);

  pinMode(9,OUTPUT);

  pinMode(10,OUTPUT);

  pinMode(11,OUTPUT);

  Serial.begin(115200);

}

void loop() {

  button = digitalRead(button_P);

  button2 = digitalRead(button_P2);

  gate = analogRead(gate_P);

  if(button == LOW){

    gate = 0;

    while(gate <200){

      stepBack();

      gate = analogRead(gate_P);

    }

  delay(1000);

  }

  if(button2 == LOW){

      for(int i=1;i<=256;i++){  //可以修改內部 i <= 256，來完成校正

      stepForward();

      }

    }

}

void stepForward(){

  digitalWrite(8,1);

  digitalWrite(9,0);

  digitalWrite(10,0);

  digitalWrite(11,0);

  delay(t);

  digitalWrite(8,1);

  digitalWrite(9,1);

  digitalWrite(10,0);

  digitalWrite(11,0);

  delay(t);

  digitalWrite(8,0);

  digitalWrite(9,1);

  digitalWrite(10,0);

  digitalWrite(11,0);

  delay(t);

  digitalWrite(8,0);

  digitalWrite(9,1);

  digitalWrite(10,1);

  digitalWrite(11,0);

  delay(t);

  digitalWrite(8,0);

  digitalWrite(9,0);

  digitalWrite(10,1);

  digitalWrite(11,0);

  delay(t);

  digitalWrite(8,0);

  digitalWrite(9,0);

  digitalWrite(10,1);

  digitalWrite(11,1);

  delay(t);

  digitalWrite(8,0);

  digitalWrite(9,0);

  digitalWrite(10,0);

  digitalWrite(11,1);

  delay(t);

  digitalWrite(8,1);

  digitalWrite(9,0);

  digitalWrite(10,0);

  digitalWrite(11,1);

  delay(t); 

}

void stepBack(){

  digitalWrite(8,1);

  digitalWrite(9,0);

  digitalWrite(10,0);

  digitalWrite(11,1);

  delay(t);

  digitalWrite(8,0);

  digitalWrite(9,0);

  digitalWrite(10,0);

  digitalWrite(11,1);

  delay(t);

  digitalWrite(8,0);

  digitalWrite(9,0);

  digitalWrite(10,1);

  digitalWrite(11,1);

  delay(t);

  digitalWrite(8,0);

  digitalWrite(9,0);

  digitalWrite(10,1);

  digitalWrite(11,0);

  delay(t);

  digitalWrite(8,0);

  digitalWrite(9,1);

  digitalWrite(10,1);

  digitalWrite(11,0);

  delay(t);

  digitalWrite(8,0);

  digitalWrite(9,1);

  digitalWrite(10,0);

  digitalWrite(11,0);

  delay(t);

  digitalWrite(8,1);

  digitalWrite(9,1);

  digitalWrite(10,0);

  digitalWrite(11,0);

  delay(t);

  digitalWrite(8,1);

  digitalWrite(9,0);

  digitalWrite(10,0);

  digitalWrite(11,0);

  delay(t);

}