#include <NewPing.h>
#include <ESP32Servo.h>

#define TRIGGER_PIN 21
#define ECHO_PIN 22
#define MAX_DISTANCE 200

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);
Servo RadarServo;

int distance;

void setup() {
  Serial.begin(115200);
  RadarServo.attach(26);
  delay(3000);
}

void loop() {
  for(int i=0; i<=180; i++) {
    RadarServo.write(i);
    delay(50);
    distance = sonar.ping_cm();
    for(int j=0; j<100; j+=25) {
      if(i==180 && j>0) {
        break;
      }
      Serial.print(i);
      Serial.print(",");
      Serial.print(j);
      Serial.print("*");
      Serial.print(1);
      Serial.print("/");
      Serial.print(distance);
      Serial.print(".");
    }
  }
}