#include <Servo.h>

Servo monServo; 
int position = 0;
int pinTrig = 2;
int pinEcho = 3;


void setup() {
  // put your setup code here, to run once:
  monServo.attach(9);
  pinMode(2, OUTPUT);
  pinMode(3, INPUT); 
  Serial.begin(9600);
}

void loop() {
  
  // put your main code here, to run repeatedly:
  //for(position = 0; position <= 180; position++){
    //monServo.write(position);
    //delay(15);
 // }

 // for(position = 180; position >= 0; position--){
  //  monServo.write(position); 
  //  delay(15);
   //  }

  // Début d'une mesure
  digitalWrite(pinTrig, LOW);     
  delayMicroseconds(2);
  digitalWrite(pinTrig, HIGH);
  delayMicroseconds(2);
  digitalWrite(pinTrig, LOW);

  // Calcul de la distance
  long duree = pulseIn(pinEcho, HIGH);
  long distance = duree*340/(2*10000);
  Serial.print("Distance = ");
  Serial.print(distance);
  Serial.println(" cm");

  if(distance <= 5): {
    for(position = 0; position <= 180; position++){
    monServo.write(position);
    delay(15);
  }

  delay(1000);
}