#include <ESP8266WiFi.h>
#include <PubSubClient.h>

#define wifi_ssid "*****"
#define wifi_password "*********"
#define mqtt_server "MQTT_SERVER_IP"
#define mqtt_user "USERNAME"
#define mqtt_password "PASSWORD"
#define Datentopic "sensor/Fahrrad"

WiFiClient espClient;
PubSubClient client(espClient);
char Inhalt[35] = "";
int n = 0;
int eins = 0;
int zwei = 0;
int drei = 0;
int vier = 0;
int Puls = 0;
int Drehzahl = 0;
int Geschwindigkeit = 0;
int Distanz = 0;
int Sollpower = 0;
int kilojoule = 0;
int IstPower = 0;
bool newData = false;
bool first = true;

void setup() {
  Serial.begin(9600);
  setup_wifi();
  client.setServer(mqtt_server, 1883);
  delay(3000);
  first = true;
  //Array initialisieren
  for (int n = 0; n <= 35; n++) {
    Inhalt[n] = '0';
  }
  //beim ersten mal kommt rubbish raus
  Serial.write("ST\r\n");   // read it and send it out Serial1 (pins 0 & 1)
  //wenn serial da ist, erstmal leeren
  while (Serial.available()) {     // If anything comes in Serial1 (pins 0 & 1)
    char muell = Serial.read();
  }
}

void setup_wifi() {
  delay(10);
  WiFi.begin(wifi_ssid, wifi_password);
  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
  }
}

void reconnect() {
  // Loop until we're reconnected
  while (!client.connected()) {
    // Attempt to connect
    // If you do not want to use a username and password, change next line to
    // if (client.connect("ESP8266Client")) {
    if (client.connect("ESP8266Client", mqtt_user, mqtt_password)) {
    } else {
      delay(5000);
    }
  }
}
void Kettler() {
  Serial.write("ST\r\n");   // read it and send it out Serial1 (pins 0 & 1)
  n = 0;
  while (Serial.available()) {     // If anything comes in Serial1 (pins 0 & 1)
    Inhalt[n] = Serial.read();
    //Serial.write(Inhalt[n]);   // read it and send it out Serial (USB)
    n++;
    newData = true;
  }
  if (newData == true) {
    //Puls
    eins = Inhalt[0] - '0';
    zwei = Inhalt[1] - '0';
    drei = Inhalt[2] - '0';
    Puls = 100 * eins + 10 * zwei + drei;

    //rpm
    eins = Inhalt[4] - '0';
    zwei = Inhalt[5] - '0';
    drei = Inhalt[6] - '0';
    Drehzahl = 100 * eins + 10 * zwei + drei;

    //Geschwindigkeit
    eins = Inhalt[8] - '0';
    zwei = Inhalt[9] - '0';
    drei = Inhalt[10] - '0';
    Geschwindigkeit = 10 * eins + 1 * zwei + drei * 0.1;

    //Distanz
    eins = Inhalt[12] - '0';
    zwei = Inhalt[13] - '0';
    drei = Inhalt[14] - '0';
    Distanz = 10 * eins + 1 * zwei + drei * 0.1;

    //Sollpower
    eins = Inhalt[16] - '0';
    zwei = Inhalt[17] - '0';
    drei = Inhalt[18] - '0';
    Sollpower = 100 * eins + 10 * zwei + drei;

    //Kilojoule
    eins = Inhalt[20] - '0';
    zwei = Inhalt[21] - '0';
    drei = Inhalt[22] - '0';
    vier = Inhalt[23] - '0';
    kilojoule = 1000 * eins + 100 * zwei + 10 * drei + vier;

    //IstPower
    eins = Inhalt[31] - '0';
    zwei = Inhalt[32] - '0';
    drei = Inhalt[33] - '0';
    IstPower = 100 * eins + 10 * zwei + drei;

    newData = false;
  }
}
void loop() {
  if (!client.connected()) {
    reconnect();
  }
  client.loop();
  Kettler();
  if (first == false) {
    client.publish("sensor/Fahrrad/Puls", String(Puls).c_str(), true);
    client.publish("sensor/Fahrrad/Drehzahl", String(Drehzahl).c_str(), true);
    client.publish("sensor/Fahrrad/Geschwindigkeit", String(Geschwindigkeit).c_str(), true);
    client.publish("sensor/Fahrrad/Distanz", String(Distanz).c_str(), true);
    client.publish("sensor/Fahrrad/Sollpower", String(Sollpower).c_str(), true);
    client.publish("sensor/Fahrrad/kilojoule", String(kilojoule).c_str(), true);
    client.publish("sensor/Fahrrad/IstPower", String(IstPower).c_str(), true);
  }
  first = false;
  delay(10000);