#include <NewPing.h>
#define TGRP 2
#define ECHP 1
#define DISTANCE 200
const int trigPin = 9;
const int echoPin = 10;
 
NewPing sonar(TGRP, ECHP, DISTANCE);
void setup() {
  Serial.begin(115200);
  
  pinMode(trigPin, OUTPUT);

  pinMode(echoPin, INPUT);

}

 

 
 
void loop() {

  digitalWrite(trigPin, LOW);

  delayMicroseconds(2);

  digitalWrite(trigPin, HIGH);

  delayMicroseconds(10);

  digitalWrite(trigPin, LOW);
 
  long duration = pulseIn(echoPin, HIGH);

  float distance_cm = duration * 0.034 / 2;
 
  Serial.print("Distance: ");

  Serial.print(distance_cm);

  Serial.println(" cm");
 
  if (distance_cm < 25) {

    Serial.println("Collision Warning");

  }
 
  delay(1000);

}