#include <Servo.h>

Servo myservo1;
Servo myservo2;

int aci = 0;
const int TRIG_PIN = 6; // Arduino pin connected to Ultrasonic Sensor 1's TRIG pin
const int ECHO_PIN = 7; 
float duration_us, distance_cm;

const int POT_VERT_PIN = A0; 
const int POT_HORZ_PIN = A1; 

int adc_horz, adc_vert;

int servo1_angle = 0;
int servo2_angle = 0;

void setup() {

  myservo1.attach(11);
  myservo2.attach(10);
  Serial.begin(115200);

  pinMode(POT_VERT_PIN, INPUT);
  pinMode(POT_HORZ_PIN, INPUT);
}

void loop() {


  adc_horz = analogRead(POT_HORZ_PIN);
  adc_vert = analogRead(POT_VERT_PIN);

  Serial.print("sensor vert:");
  Serial.print(adc_vert);

  Serial.print("\tsensor horz:");
  Serial.println(adc_horz);

  if(adc_horz > 750 ){
    servo1_angle += 10;
    if(servo1_angle > 180)
      servo1_angle = 180;

  }
  if(adc_horz < 250 ){
    servo1_angle -= 10;
      if(servo1_angle < 0)
      servo1_angle = 0;
  }
  
  if(adc_vert > 750 ){
    servo2_angle +=10;
        if(servo2_angle > 180)
            servo2_angle = 180;
  }
  if(adc_vert < 250 ){
    servo2_angle -=10;
          if(servo2_angle < 0)
            servo2_angle = 0;
  }

  myservo1.write(servo1_angle);
  myservo2.write(servo2_angle);
  delay(50);

}



 // hc-sr04 sensörü okuma kodu
float ReadUltrasonicSensor(){
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  duration_us = pulseIn(ECHO_PIN, HIGH);
  distance_cm = 0.017 * duration_us;

  Serial.print("sensor mesafe:");
  Serial.println(distance_cm);

  return distance_cm;
}