#include<ServoMotor.h>
#include <WiFi.h>
#include <PubSubClient.h>
const int servoPin = 18;
Servo servo;

void callback(char* topic, byte* payload, unsigned int length1)
{
  Serial.print("message arrived[");
  Serial.print(topic);
  Serial.println("]");

  for (int i = 0; i < length1; i++) {
    Serial.print(payload[i]);
    if (payload[0] == 49) {
      digitalWrite(2, HIGH);
      Serial.print("LED ON");
    } //ASCII VALUE OF '1' IS 49
    else if (payload[0] == 50) {
      digitalWrite(2, LOW);
      Serial.print("LED OFF");
    } //ASCII VALUE OF '2' IS 50
    Serial.println();
  }
}

PubSubClient client(mqtt_server, 1883, callback, espclient);

void setup() {

  pinMode(2, OUTPUT);
  Serial.begin(115200);

  // Connect to WIFI
  Serial.print("connecting to ");
  Serial.print(ssid);
  WiFi.begin(ssid, password);
  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
    Serial.print(".");
  }
  Serial.println();

  // Servo setup
  servo.attach(servoPin, 500, 2400);

  // Set initial servo position
  servo.write(0);