#include <Servo.h>
#include <NewPing.h>

const int trigPin = 12;
const int echoPin = 11;
const int btn0 = 6;
const int btn1 = 5;
const int servo0 = 2;
const int servo1 = 4;

Servo ser0;
Servo ser1;
NewPing sonar(trigPin, echoPin, 200);

void setup() {
  ser0.attach(servo0);
  ser0.write(0);
  ser1.attach(servo1);
  ser1.write(0);
  pinMode(btn0, INPUT);
  pinMode(btn1, INPUT);
}

void loop() {
  unsigned int distance = sonar.ping_cm();
  
  if (distance > 0 && distance < 230) { // Check if the distance is within the range
    ser1.write(90); // Set to 90 degrees
  } else { // If the distance is not within the range
    ser1.write(0); // Set to 0 degrees
  }

  bool btn1State = digitalRead(btn1);
  bool btn0State = digitalRead(btn0);

  if (btn0State == HIGH) {
    ser0.write(180);
  }

  if (btn1State == HIGH) {
    static int servoAngle = 0;
    if (servoAngle < 180) {
      servoAngle++;
      ser0.write(servoAngle);
      delay(20);

      if (servoAngle > 179) {
        servoAngle = 0;
      }
    }
  }
}