udp_RoboRemo_2LEDS_0514

#include <ESP8266WiFi.h>
#include <WiFiUdp.h>

// config:

const char *ssid = "WEMOS_WIFI";  // Wifi AP neve
const char *pw = "nincs"; // WifiAP jelszava
const int ledPin = 14;
IPAddress ip(192, 168, 1, 10); // Wemos ip címe
IPAddress netmask(255, 255, 255, 0);

WiFiUDP UDPTestServer;
unsigned int UDPPort = 4000; //udp szerver portja
const int packetSize = 4; // csomag mérete, 4 byte
byte packetBuffer[packetSize];

void setup() {
  pinMode(ledPin, OUTPUT);
  pinMode(LED_BUILTIN, OUTPUT);
  Serial.begin(115200);
  Serial.println();
  WiFi.softAPConfig(ip, ip, netmask); // WifiAp ip címének, netmaskjának beállítása
  WiFi.softAP(ssid, pw); // WifiAp SSID és jelszó beállítása

  Serial.println("Wemos D1R2 UDP teszt"); // mégis mire jó...
  Serial.println((String)"SSID: " + ssid + "  PASS: " + pw);
  Serial.println((String)"RoboRemo app must connect to " + ip.toString() + ":" + UDPPort);

  UDPTestServer.begin(UDPPort);
}


void loop() {
   handleUDPServer();
   //delay(1);
}

void handleUDPServer() {
  int cb = UDPTestServer.parsePacket();
  int uzenet;
  if (cb) {
  int len = UDPTestServer.read(packetBuffer, packetSize);
   if (len > 0){
    UDPTestServer.read(packetBuffer, packetSize);
    String myData = "";
    for(int i = 0; i < packetSize; i++) {
      myData += (char)packetBuffer[i];
    }
    Serial.println(myData);
    uzenet = myData.toInt();
    if (uzenet == 500)
      {
         Serial.println("500-es érkezik, led BE...");
        digitalWrite(ledPin, HIGH);
        }
    if (uzenet == 501)
      {
         Serial.println("501 érkezik, led KI...");
        digitalWrite(ledPin, LOW);
   }
    if (uzenet == 502)
      {
         Serial.println("502-es érkezik, BUILTINled BE...");
        digitalWrite(LED_BUILTIN, LOW);
        }
    if (uzenet == 503)
      {
         Serial.println("503 érkezik, BUILTINled KI...");
        digitalWrite(LED_BUILTIN, HIGH);
   }
  }
 }
}