#include <Arduino.h>
#include <SPI.h>
#include <MFRC522.h>
#include <ESP8266WiFi.h>
#include <EEPROM.h>
#include <Wire.h>
#include <WiFiClient.h>
#include <PubSubClient.h>

#define SS_PIN D8
#define RST_PIN D1
MFRC522 mfrc522(SS_PIN, RST_PIN);
unsigned long cardId = 0;



const char* ssid = "FRITZ!Box 6490 Cable_plus";
const char* password = "010166Hamburg";

const char* mqtt_server = "technight.duckdns.org";
const char* mqtt_username ="homeassistant-1";
const char* mqtt_password = "t4KG95TT89pLSVSbkk";
const char* clientID = "MusikBox";


// constants won't change. They're used here to set pin numbers:
const int buttonPin = 2;     // the number of the pushbutton pin
//const int ledPin =  13;      // the number of the LED pin

// Variables will change:
int buttonPushCounter = 0;   // counter for the number of button presses
int buttonState = 0;         // current state of the button
int lastButtonState = 1;     // previous state of the button

// RGB LED pins:
int redPin = 16;    // RED GPIO pin
int greenPin = 0;   // GREEN GPIO pin
int bluePin = 4;    // BLUE GPIO pin

WiFiClient espClient;
PubSubClient client(espClient);


void callback(char* topic, byte* payload, unsigned int length) {
  String receivedString1 = "000";
  String receivedString = "0";
  int receivedInt1;
  int receivedInt2;
  int receivedInt3;
  String tmpreceivedString1;
  String tmpreceivedString2;
  String tmpreceivedString3;

  Serial.print("Message arrived [");
  Serial.print(topic);
  Serial.print("] ");
  for (int i = 0; i < length; i++) {
    char receivedChar = (char)payload[i];
    receivedString = String(receivedString+receivedChar);
    Serial.print(receivedChar);
    }

      tmpreceivedString1 = receivedString.substring(0,3);
      receivedInt1 = tmpreceivedString1.toInt();

      tmpreceivedString2 = receivedString.substring(4,7);
      receivedInt2 = tmpreceivedString2.toInt();

      tmpreceivedString3 = receivedString.substring(8,11);
      receivedInt3 = tmpreceivedString3.toInt();

      Serial.println();
      Serial.println(receivedInt1);
      Serial.println(receivedInt2);
    Serial.println(receivedInt3);


 }

// void callback(char* topic, byte* payload, unsigned int length) {

  // Serial.print("Message arrived [");
  // Serial.print(topic);
  // Serial.print("] ");
  // for (int i = 0; i < length; i++) {
  //   char receivedChar = (char)payload[i];
  //   Serial.print(receivedChar);
    // if (receivedChar == '0')
    //   digitalWrite(LED_BUILTIN, HIGH);
    // if (receivedChar == '1')
    //   digitalWrite(LED_BUILTIN, LOW);
        // setColor(receivedInt1, receivedInt2, receivedInt3);
    // if (receivedChar == '2')
    //   setColor(255, 000, 000);
    // if (receivedChar == '3')
    //   setColor(000, 255, 000);
    // if (receivedChar == '4')
    //   setColor(000, 000, 255);

//   }
//   Serial.println();
//   Serial.println(receivedInt1);
//   Serial.println(receivedInt2);
//   Serial.println(receivedInt3);
//   Serial.println();
// }


void setup()
{
  {
    SPI.begin();
    mfrc522.PCD_Init();
    client.setServer(mqtt_server, 1883);
    client.setCallback(callback);

    // initialize the button pin as a input:
    pinMode(buttonPin, INPUT);
    // initialize the LED as an output:
    pinMode(LED_BUILTIN, OUTPUT);
    // initialize led status communication:
    pinMode(redPin, OUTPUT);
    pinMode(greenPin, OUTPUT);
    pinMode(bluePin, OUTPUT);
    digitalWrite(redPin,HIGH);
    delay(300);
    digitalWrite(redPin,LOW);
    delay(300);
    digitalWrite(redPin,HIGH);
    delay(300);
    digitalWrite(redPin,LOW);
    // initialize serial communication:
    Serial.begin(9600);
  }

// Connect to WiFinetwork
  Serial.println();
  Serial.println();
  Serial.print("Connecting to ");
  Serial.println(ssid);

  WiFi.begin(ssid, password);

  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
    //Serial.begin(9600);
    Serial.print(".");
  }
  Serial.println("");
  Serial.println("WiFi connected");
  // Serial.begin(9600);
  // Start the server
  // server.begin();
  // Serial.println("Server started");
  // Serial.begin(9600);
  // Print the IP address
  Serial.print("Local IP: ");
  Serial.println(WiFi.localIP());
}

void reconnect() {
  // Loop until we're reconnected
  while (!client.connected()) {
    Serial.println("Attempting MQTT connection...");
    // Attempt to connect
    if (client.connect(clientID, mqtt_username, mqtt_password)) {
      Serial.println("Connected");
      setColor(57, 149, 60);  // green
      // ... and subscribe to topic
      client.subscribe("/technight/Interface/PlayBox/button");
    } else {
      Serial.print("failed, rc=");
      digitalWrite(redPin,HIGH);
      Serial.print(client.state());
      Serial.println(" try again in 5 seconds");
      delay(300);
      digitalWrite(redPin,LOW);
      // Wait 5 seconds before retrying
      delay(3000);
    }
  }
}

void loop() {

//  // read the state of the pushbutton value:
//  buttonState = digitalRead(buttonPin);
//
//  // check if the pushbutton is pressed. If it is, the buttonState is HIGH:
//  if (buttonState == HIGH) {
//    // turn LED on:
//    digitalWrite(LED_BUILTIN, HIGH);
//  } else {
//    // turn LED off:
//    digitalWrite(LED_BUILTIN, LOW);
//  }
//}
//

  // read the pushbutton input pin:
  buttonState = digitalRead(buttonPin);

  // setColor(255, 0, 0);  // red
  // Serial.println("ROT");
  // delay(2000);
  // setColor(255, 0, 255);  // red
  // Serial.println("LILA");
  // delay(2000);
  // setColor(0, 255, 0);  // green
  // Serial.println("GRÜN");
  // delay(2000);
  // setColor(0, 0, 255);  // blue
  // Serial.println("BLAU");
  // delay(2000);
  // setColor(255, 255, 0);  // yellow
  // Serial.println("GELB");
  // delay(2000);
  // setColor(80, 0, 80);  // purple
  // Serial.println("PURPLE");
  // delay(2000);
  // setColor(255, 50, 0);  // Orange
  // Serial.println("ORANGE");
  // delay(2000);

  // compare the buttonState to its previous state
  if (buttonState != lastButtonState) {
    // if the state has changed, increment the counter
    if (buttonState == HIGH) {
      client.publish("/technight/Interface/PlayBox/button", "OFF"); //
      // if the current state is HIGH then the button
      // went from off to on:
    } else {
      // if the current state is LOW then the button
      // went from on to off:
      client.publish("/technight/Interface/PlayBox/button", "ON"); //
    }
    // Delay a little bit to avoid bouncing
    delay(100);
  }
  // save the current state as the last state,
  //for next time through the loop
  lastButtonState = buttonState;

  {
    if (!client.connected()) {
      reconnect();
    }
    client.loop();
  }
  if (!mfrc522.PICC_IsNewCardPresent()) {
    return;
  }

  if (!mfrc522.PICC_ReadCardSerial()) {
    return;
  }

  cardId = getCardId();

  digitalWrite(greenPin,LOW);
  digitalWrite(bluePin,HIGH);
  Serial.print("Message arrived [/technight/Interface/PlayBox] ");
  Serial.println(cardId);

  char buffer[10];
  sprintf(buffer, "%lu", cardId);
  client.publish("/technight/Interface/PlayBox", buffer);
  delay(200);
  digitalWrite(bluePin,LOW);
  setColor(57, 149, 60);  // green

  uint8_t control = 0x00;

  do {
    control = 0;
    for (int i = 0; i < 3; i++) {
      if (!mfrc522.PICC_IsNewCardPresent()) {
        if (mfrc522.PICC_ReadCardSerial()) {
          control |= 0x16;
        }

        if (mfrc522.PICC_ReadCardSerial()) {
          control |= 0x16;
        }

        control += 0x1;
      }

      control += 0x4;
    }

    delay(0);
  } while (control == 13 || control == 14);

  reconnect();

  Serial.println("Message arrived [/technight/Interface/PlayBox] 1");
  client.publish("/technight/Interface/PlayBox", "1");
  delay(500);

  mfrc522.PICC_HaltA();
  mfrc522.PCD_StopCrypto1();
}

unsigned long getCardId() {
  byte readCard[4];
  for (int i = 0; i < 4; i++) {
    readCard[i] = mfrc522.uid.uidByte[i];
  }

  return (unsigned long)readCard[0] << 24
    | (unsigned long)readCard[1] << 16
    | (unsigned long)readCard[2] << 8
    | (unsigned long)readCard[3];
}

void setColor(int red, int green, int blue)
{
  analogWrite(redPin, red);
  analogWrite(greenPin, green);
  analogWrite(bluePin, blue);
}