ArtificialEyes

#include <ESP32Servo.h>
#include "BluetoothSerial.h"

BluetoothSerial SerialBT;

#define WARNING_LOW   40
#define HOLE_DISTANCE 120
#define WALL_DISTANCE 70
#define WARNING_HIGH  60

void setup() {
  Serial.begin(115200);
  SerialBT.begin("ArtificialEye_Hardware");
  Serial.println("Bluetooth started: ArtificialEye_Hardware");
}

void loop() {
  checkBluetoothConnection();
  readBluetoothCommand();

  if (servoScanEnabled) {
    moveServoSmooth(50, 65, 130, 120);
    scanAtPosition(65, 120, 1);

    moveServoSmooth(65, 90, 120, 99);
    scanAtPosition(90, 99, 2);

    moveServoSmooth(90, 100, 99, 90);
    scanAtPosition(100, 90, 3);
  }
}