#include <Servo.h>
Servo servol;
int trigPin = 10;
int echoPin = 9;
int point = 0;
long distance;
long duration;
int x = 0;
unsigned long previousMillis = 0;
unsigned long currentMillis = millis();
unsigned long startTime;
int angle = 0;

void setup()
{
  Serial.begin(9600);
  servol.attach(8);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
}

void loop() 
{
  ultra();
  if(distance <= 10)
  {
    angle = 180;
    servol.write(180);
    delay(3000);
  }
  else
  {
    angle = 0;
    servol.write(0);
  }
  if (angle < 100 && (millis() - startTime) > 6000) {
    point++;
    Serial.print("point: ");
    Serial.println(point);
    startTime = millis(); // รีเซ็ตเวลาเริ่มต้น
  }
}

void ultra()
{
  digitalWrite(trigPin, 0);
  delayMicroseconds(2);
  digitalWrite(trigPin, 1);
  delayMicroseconds(10);
  digitalWrite(trigPin, 0);
  duration = pulseIn(echoPin,1);
  distance = duration*0.034/2;
  ///Serial.println(point);


}