Untitled

 avatar
unknown
c_cpp
a year ago
1.2 kB
6
Indexable
#define button 10
int buttonState = 0;

#define in1 7
#define in2 8
#define enA 5 
#define enB 6
#define stby 3


void forward(){
  digitalWrite(in1, HIGH);
  digitalWrite(in2, HIGH);
  analogWrite(enA, 75);
  analogWrite(enB, 75);
}

void back(){
  digitalWrite(in1, LOW); 
  digitalWrite(in2, LOW);
  analogWrite(enA, 75);
  analogWrite(enB, 75); 
}

void right(){
  digitalWrite(in1, LOW); 
  digitalWrite(in2, HIGH);
  analogWrite(enA, 50);
  analogWrite(enB, 50);
}

void left(){
  digitalWrite(in1, HIGH); 
  digitalWrite(in2, LOW);
  analogWrite(enA, 50);
  analogWrite(enB, 50);
}

void stop(){
  digitalWrite(in1, LOW); 
  digitalWrite(in2, LOW);
  analogWrite(enA, 0);
  analogWrite(enB, 0);
}


void setup() 
{

  pinMode(enA, OUTPUT);
  pinMode(in1, OUTPUT);
  pinMode(in2, OUTPUT);
  pinMode(enB, OUTPUT);
  pinMode(stby, OUTPUT);
  pinMode(button, INPUT_PULLUP);

}


void loop() 
{

    buttonState = digitalRead(button);
    
    if (buttonState == LOW) {
      digitalWrite(stby, HIGH);

      forward();
      delay(500);

      back();
      delay(500);

      right();
      delay(500);

      left();
      delay(500);
    }
    else {
      stop();
      delay(10000);
    }
}
Editor is loading...
Leave a Comment