Esp32 bluetooth сервопривод

В это коде при преподнесение смарт часов к плате, загорается светодиод.

При отдаление смарт часов , светодиод гаснет.

мне хотелось что бы еще и сервопривод поворачивался когда преподношу на 180 градусов,

и при отдаление на 180 градусов в противоположную сторону.

ПОМОГИТЕ с кодом ПОЖАЛУЙСТА

Код (C++):

#include <BLEAdvertisedDevice.h>
#include <BLEDevice.h>
#include <BLEScan.h>
#include <Servo.h>
Servo myservo;

const int PIN = 2;
const int CUTOFF = -60;

void setup() {
  pinMode(PIN, OUTPUT);
  BLEDevice::init("EF:33:63:43:EE:BC");
  myservo.attach(13);
}

void loop() {
  BLEScan *scan = BLEDevice::getScan();
  scan->setActiveScan(true);
  BLEScanResults results = scan->start(1);
  int ROS = CUTOFF;
  for (int i = 0; i < results.getCount(); i++) {
    BLEAdvertisedDevice device = results.getDevice(i);
    int rssi = device.getRSSI();
    if (rssi > ROS) {
      ROS = rssi;
    }
  }
  digitalWrite(PIN, ROS > CUTOFF ? HIGH : LOW);
}