#include <ESP32Servo.h>

#define SL 12
#define SR 13
#define PTN 2
#define PTNS 0
#define BTN 15

Servo servol;
Servo servoR;
int lastSpeed = 0;
int lastangle = 90; 

void setup() {
  pinMode(SR, OUTPUT);
  pinMode(SL, OUTPUT);
  pinMode(PTN, INPUT);
  pinMode(PTNS, INPUT);
  pinMode(BTN, INPUT_PULLUP);

  servol.attach(SL);
  servoR.attach(SR);

  Serial.begin(115200);
}

void loop() {
  int potenValue1 = analogRead(PTN);
  int potenValue2 = analogRead(PTNS);
  int btnState = digitalRead(BTN);

  int angle = map(potenValue1, 0, 4095, 0, 180);
  int speed = map(potenValue2, 0, 4095, 0, 200);

  servol.write(angle);
  servoR.write(angle);


  if (speed != lastSpeed) { 
    lastSpeed = speed;
    Serial.print("Speed km/hr: ");
    Serial.println(speed);
  }

  if (btnState == LOW) { 
    lastSpeed = 0;
    Serial.println("Brake");
  }

  delay(100);
}