#include <Servo.h> // incluimos la libreria Servo.h para hacer funcionar los servomotores
#include <Servo.h>
#include <NewPing.h> // incluimos la librería NewPing.h par que asi podamos leer la distancia
#define TRIGGER_PIN 7 // asignamos TRIGGER al pin 7
#define ECHO_PIN 6 // asignamos ECHO al pin 6
#define DIST_MAX 200 
NewPing sonar(TRIGGER_PIN, ECHO_PIN, DIST_MAX);
int dist=0;
Servo servobar; // pondremos etiquetas a los dos servos: servobar y servobar1
Servo servobar1;

void setup()
{
  servobar.attach (5); // asignamos el primer servomotor al pin 5
  servobar1.attach (4); // asignamos el segundo al pin 4
  Serial.begin(9600);
}

void loop()
{
  servobar.write(-180); // los servos comienzan a girar -180º y 180º para avanzar hacia adelante 
  servobar1.write(180);
unsigned int uS = sonar.ping(); //la variable uS recoge los datos del sensor
Serial.print("Distancia: ");// imprime por pantalla la palabra Distancia
Serial.print(uS / US_ROUNDTRIP_CM); // convertirmos la distancia en cm
Serial.println(" cm"); // imprime por pantalla la palabra cm
dist = uS / US_ROUNDTRIP_CM;
if (dist < 4) { // si la distancia es menor que 4 cm, los servomotores girarán en sentido contrario...
  servobar.write(180);
  servobar1.write(-180);
  delay(3000); // por 3 segundos hasta que el sensor no detecte nada
}
}