// Motor Driver Shield (L298N) Example with Arduino

// Motor A pin connections
const int enA = 9;
const int in1 = 8;
const int in2 = 7;

// Motor B pin connections
const int enB = 3;
const int in3 = 5;
const int in4 = 4;

void setup() {
  // Set all motor control pins as outputs
  pinMode(enA, OUTPUT);
  pinMode(in1, OUTPUT);
  pinMode(in2, OUTPUT);

  pinMode(enB, OUTPUT);
  pinMode(in3, OUTPUT);
  pinMode(in4, OUTPUT);

  // Start serial communication
  Serial.begin(9600);
  Serial.println("YSEF Motor Driver Ready");
}

void loop() {
  // Move both motors forward
  digitalWrite(in1, HIGH);
  digitalWrite(in2, LOW);
  digitalWrite(in3, HIGH);
  digitalWrite(in4, LOW);
  analogWrite(enA, 200); // PWM speed control (0-255)
  analogWrite(enB, 200);
  delay(2000);            // Run forward for 2 seconds

  // Stop motors
  digitalWrite(in1, LOW);
  digitalWrite(in2, LOW);
  digitalWrite(in3, LOW);
  digitalWrite(in4, LOW);
  delay(1000);            // Pause for 1 second

  // Move both motors in reverse
  digitalWrite(in1, LOW);
  digitalWrite(in2, HIGH);
  digitalWrite(in3, LOW);
  digitalWrite(in4, HIGH);
  analogWrite(enA, 200);
  analogWrite(enB, 200);
  delay(2000);            // Run in reverse for 2 seconds
}