/*
TS-126 Ultrasonic Range Sensor Example Sketch
Vcc -> Arduino 5V
Echo -> Arduino Pin 12
Trig -> Arduino Pin 13
GND -> Arduino GND
*/

#define trigPin 13
#define echoPin 12

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

void loop() {
  long duration, distance;
  digitalWrite(trigPin, LOW);  
  delayMicroseconds(2); 
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10); 
  digitalWrite(trigPin, LOW);
  duration = pulseIn(echoPin, HIGH);
  distance = (duration/2) / 29.1;

  if (distance >= 200 || distance <= 0){
    Serial.println("Too Far");
  }
  else {
    Serial.print(distance);
    Serial.println(" cm");
  }
  delay(500);
}