toshiba_2.ino

#include "arduino.h"
#include <WiFi.h>
#include <AsyncTCP.h>
#include <ArduinoOTA.h>
#include <AsyncMqttClient.h>
#include <TelnetStream.h>

IPAddress ip(192, 168, 1, 150);
IPAddress gateway(192, 168, 1, 254);
IPAddress subnet(255, 255, 255, 0);
#define MQTT_HOST IPAddress(192, 168, 1, 113)
#define MQTT_PORT 1883
const char *hostname = "heatpump";
const char *ssid = "SSID";
const char *password = "PASSWORD";

const int LED = 2;
bool led_state = 0;

//*******constructors***********

AsyncMqttClient mqttClient;

//***********globals************
int mqtt_status = false;
String power_state = "OFF";
int offtimer = 0;
char payload[100] = {0};
char topic[50] = {0};
bool validData = 0;

void setup() {
  Serial.begin(115200); //console
  Serial2.begin(9600, SERIAL_8E1, 32, 33); //rx/tx
  Serial2.setTimeout(100);
  Serial.println("boot");
  pinMode(LED, OUTPUT);
  mqttClient.onConnect(onMqttConnect);
  mqttClient.onDisconnect(onMqttDisconnect);
  mqttClient.onSubscribe(onMqttSubscribe);
  mqttClient.onUnsubscribe(onMqttUnsubscribe);
  mqttClient.onMessage(onMqttMessage);
  mqttClient.onPublish(onMqttPublish);
  mqttClient.setServer(MQTT_HOST, MQTT_PORT);
  mqttClient.setClientId(hostname);

  WIFI_Connect();
  mqtt_connect();
  otastart();
  TelnetStream.begin();
  digitalWrite(LED, true);
  start_handshake();
  delay(1000);
  doinit();
}

void loop() {
  mqtt_connect();
  WIFI_Connect();
  ArduinoOTA.handle();
  serialHandler();
  watchdog();
    offmode();
  parse();
  reboot();
}

void offmode() {
  if (offtimer != 0) {
    if ((millis() - offtimer) > 3600000) { //   60 minute
      offtimer = 0;
      char val[4] = "OFF";
      stateControl(val);
    }
  }
}

void watchdog() {
  static long int timer = 0;
  if ((millis() - timer) > 60000) { //   1 minute
    timer = millis();
    dowatchdog();
  }
}

void serialHandler() {
  static int state = 0;
  int a = 0;
  if (Serial2.available()) {
    switch (state) {

      case 0: //look for header
        a = Serial2.read();
        TelnetStream.print(a);
        if (a == 2) state = 1;
        break;

      case 1: //look for header
        a = Serial2.read();
        TelnetStream.print(a);
        state = 0;
        if (a == 0) state = 2;
        break;

      case 2: //look for header
        a = Serial2.read();
        TelnetStream.print(a);
        state = 0;
        if (a == 3) state = 3;
        break;

      case 3:
        byte datah[64] = {0};
        byte data[64] = {0};
        state = 0;
        Serial2.readBytes(datah, 4); //header
        int more = datah[3]; //length of remaining data
        if (more <= 30) {
          int len = Serial2.readBytes(data, more + 1);
          TelnetStream.print("*I*");
          Serial.print("***");
          for (int i = 0; i < len; i++) {
            Serial.print(data[i], DEC);
            Serial.print('.');
            TelnetStream.print(data[i], DEC);
            TelnetStream.print('.');
          }
          TelnetStream.println("*I*");
          Serial.println("***");

          if (len == 10) {
            data[5] = data[7];
            data[6] = data[8];
          }
          if (len == 8 || len == 10 || len == 7) {

            if (data[5] == 187) { //14
              String sub1 = "/roomtemp";
              mqtt_int(sub1, data[6]);
            }
            if (data[5] == 190) {
              String sub1 = "/outdoortemp";
              mqtt_int(sub1, int_to_signed(data[6]));
            }
            if (data[5] == 179) {
              String sub1 = "/setpoint/state";
              mqtt_int(sub1, int_to_signed(data[6]));
            }
            if (data[5] == 128) {
              String sub1 = "/state/state";
              String state = inttostate(data[6]);
              mqtt_int(sub1, state);
              power_state = state;
              if (state == "OFF") {
                // when power state is OFF, sent unit mode also as "off"
                mqtt_int("/mode/state", "off");
              }
            }
            if (data[5] == 160) {
              String sub1 = "/fanmode/state";
              mqtt_int(sub1, inttofanmode(data[6]));
            }
            if (data[5] == 163) { //14
              String sub1 = "/swingmode/state";
              mqtt_int(sub1, inttoswing(data[6]));
            }
            if (data[5] == 176) {
              String mode = "off";
              String sub1 = "/mode/state";
              // report actual mode when unit is running or "off" when it's not
              if (power_state == "ON") mode = inttomode(data[6]);
              mqtt_int(sub1, mode);
            }
            break;

          }
        }
    }
  }
}

void mqtt_int(String sub1, int param) {
  String subs = hostname + sub1;
  char val[10] = {0};
  itoa(param, val, 10);
  MQTTSend(subs.c_str(), val);
}

void mqtt_int(String sub1, String val) {
  String subs = hostname + sub1;
  MQTTSend(subs.c_str(), val.c_str());
}

void start_handshake() {

  int a = 8;
  int bootlist1[a] = {2, 255, 255, 0, 0, 0, 0, 2};
  doArray(bootlist1, a);
  a = 9;
  int bootlist2[a] = {2, 255, 255, 1, 0, 0, 1, 2, 254};
  doArray(bootlist2, a);
  a = 10;
  int bootlist3[a] = {2, 0, 0, 0, 0, 0, 2, 2, 2, 250};
  doArray(bootlist3, a);
  a = 10;
  int bootlist4[a] = {2, 0, 1, 129, 1, 0, 2, 0, 0, 123};
  doArray(bootlist4, a);
  a = 10;
  int bootlist5[a] = {2, 0, 1, 2, 0, 0, 2, 0, 0, 254};
  doArray(bootlist5, a);
  a = 7;
  int bootlist6[a] = {2, 0, 2, 0, 0, 0, 0, 254};
  doArray(bootlist6, a);
  delay(1800);
  //aftershake
  a = 10;
  int bootlist7[a] = {2, 0, 2, 1, 0, 0, 2, 0, 0, 251};
  doArray(bootlist7, a);
  a = 10;
  int bootlist8[a] = {2, 0, 2, 2, 0, 0, 2, 0, 0, 250};
  doArray(bootlist8, a);
}

void doArray(int array[], int a) {
  for (int i = 0; i < a; i++) {
    Serial.print(array[i]);
    Serial2.write(array[i]);
  }
  Serial.println(' ');
  delay(200);
}

int modetoint( char *msg) {
  int retint = 0;
  if (strcmp(msg, "auto") == 0) retint = 65;
  if (strcmp(msg, "cool") == 0) retint = 66;
  if (strcmp(msg, "heat") == 0) retint = 67;
  if (strcmp(msg, "dry") == 0) retint = 68;
  if (strcmp(msg, "fan_only") == 0) retint = 69;
  return retint;
}

String inttomode (byte val) {
  String reply;
  if (val == 65) reply = "auto";
  if (val == 66) reply = "cool";
  if (val == 67) reply = "heat";
  if (val == 68) reply = "dry";
  if (val == 69) reply = "fan_only";
  return reply;
}

int fanmodetoint(char *msg) {
  int retint = 0;
  if (strcmp(msg, "quiet") == 0) retint = 49;
  if (strcmp(msg, "lvl_1") == 0) retint = 50;
  if (strcmp(msg, "lvl_2") == 0) retint = 51;
  if (strcmp(msg, "lvl_3") == 0) retint = 52;
  if (strcmp(msg, "lvl_4") == 0) retint = 53;
  if (strcmp(msg, "lvl_5") == 0) retint = 54;
  if (strcmp(msg, "auto") == 0) retint = 65;
  return retint;
}

String inttofanmode (byte val) {
  String reply;
  if (val == 49) reply = "quiet";
  if (val == 50) reply = "lvl_1";
  if (val == 51) reply = "lvl_2";
  if (val == 52) reply = "lvl_3";
  if (val == 53) reply = "lvl_4";
  if (val == 54) reply = "lvl_5";
  if (val == 65) reply = "auto";
  return reply;
}


int swingtoint(char *msg) {
  int retint = 0;
  if (strcmp(msg, "off") == 0) retint = 49;
  if (strcmp(msg, "on") == 0) retint = 65;
  return retint;
}

String inttoswing (byte val) {
  String reply;
  if (val == 49) reply = "off";
  if (val == 65) reply = "on";
  return reply;
}

int statetoint(char *msg) {
  int retint = 0;
  if (strcmp(msg, "OFF") == 0) retint = 49;
  if (strcmp(msg, "ON") == 0) retint = 48;
  return retint;
}

String inttostate (byte val) {
  String reply;
  if (val == 49) reply = "OFF";
  if (val == 48) reply = "ON";
  return reply;
}

int int_to_signed(int val) {
  if (val > 127) val = (256 - val) * -1;
  return val;
}

int checksum(int msg, int function) {
  int retval = 0;
  int numb = 434 - msg - function;
  if (numb > 256) {
    retval = numb - 256;
  } else {
    retval = numb;
  }
  return retval;
}

void otastart() {
  ArduinoOTA.setHostname(hostname);
  ArduinoOTA.setPort(8266);
  ArduinoOTA.onStart([]() {
    Serial.println("Start");
  });
  ArduinoOTA.onEnd([]() {
    Serial.println("\nEnd");
  });
  ArduinoOTA.onProgress([](unsigned int progress, unsigned int total) {
    Serial.printf("Progress: %u%%\r", (progress / (total / 100)));
  });
  ArduinoOTA.onError([](ota_error_t error) {
    Serial.printf("Error[%u]: ", error);
    if (error == OTA_AUTH_ERROR) Serial.println("Auth Failed");
    else if (error == OTA_BEGIN_ERROR) Serial.println("Begin Failed");
    else if (error == OTA_CONNECT_ERROR) Serial.println("Connect Failed");
    else if (error == OTA_RECEIVE_ERROR) Serial.println("Receive Failed");
    else if (error == OTA_END_ERROR) Serial.println("End Failed");
  });
  ArduinoOTA.begin();
  Serial.println("Ready");
  Serial.print("IP address: ");
  Serial.println(WiFi.localIP());
}

void WIFI_Connect() {
  if (WiFi.status() != WL_CONNECTED) {
    WiFi.config(ip, gateway, subnet);
    Serial.println("Connect WiFi...");
    WiFi.mode(WIFI_STA);
    WiFi.begin(ssid, password);
    Serial.println(WiFi.macAddress());

    for (int i = 0; i < 50; i++) {
      if (WiFi.status() != WL_CONNECTED) {
        delay(500);
        Serial.print(".");
        delay(500);
        digitalWrite(LED, led_state);
        led_state != led_state;
      }
    }
    Serial.println(WiFi.localIP());
    if (WiFi.status() != WL_CONNECTED) {
      ESP.restart();
    }
  }
}


void onMqttConnect(bool sessionPresent) {
  Serial.print("Connected to MQTT.");
  Serial.print("Session present: ");
  Serial.println(sessionPresent);
  String sub1 = "/#";
  String subs = hostname + sub1;
  mqttClient.subscribe(subs.c_str(), 1);
}

void onMqttDisconnect(AsyncMqttClientDisconnectReason reason) {
  Serial.println("Disconnected from MQTT.");
  mqtt_status = false;
}

void onMqttSubscribe(uint16_t packetId, uint8_t qos) {
  Serial.print("Subscribe acknowledged.");
  Serial.print("  packetId: ");
  Serial.print(packetId);
  Serial.print("  qos: ");
  Serial.println(qos);
}

void onMqttUnsubscribe(uint16_t packetId) {
  Serial.print("Unsubscribe acknowledged.");
  Serial.print("  packetId: ");
  Serial.println(packetId);
}

void mqtt_connect() {
  if (mqtt_status == false && WiFi.status() == WL_CONNECTED) {
    Serial.println("Connecting to MQTT...");
    mqttClient.connect();
    mqtt_status = true;
  }
}

void onMqttMessage(char *topic1, char *payload1,
                   AsyncMqttClientMessageProperties properties, size_t len, size_t index,
                   size_t total) {
    Serial.println(topic1);
    Serial.println(payload1);
    Serial.println(len);
  strncpy(topic, topic1, 49);
  if (len < 99) {
    strncpy(payload, payload1, len);
    payload[len] = '\0';
    validData = 1;
  }
}

void parse() {
  if (validData == 1) {
    validData = 0;
    //    Serial.println(topic);
    //    Serial.println(payload);

    if ( strcmp(topic, (hostname + String("/setpoint/set")).c_str()) == 0) {
      Serial.print("setpoint ");
      Serial.println(payload);
      setpointVal(payload);
    }
    if ( strcmp(topic, (hostname + String("/state/set")).c_str()) == 0) {
      Serial.print("state ");
      Serial.println(payload);
      stateControl(payload);
    }
    if ( strcmp(topic, (hostname + String("/fanmode/set")).c_str()) == 0) {
      Serial.print("fanmode ");
      Serial.println(payload);
      fanControl(payload);
    }
    if ( strcmp(topic, (hostname + String("/swingmode/set")).c_str()) == 0) {
      Serial.print("swingmode ");
      Serial.println(payload);
      swingControl(payload);
    }
    if ( strcmp(topic, (hostname + String("/mode/set")).c_str()) == 0) {
      Serial.print("mode ");
      Serial.println(payload);
      modeControl(payload);
    }
    if ( strcmp(topic, (hostname + String("/doinit")).c_str()) == 0) {
      Serial.print("doinit ");
      Serial.println(payload);
      doinit();
    }
    if ( strcmp(topic, (hostname + String("/restart")).c_str()) == 0) {
      Serial.print("restart ");
      Serial.println(payload);
      ESP.restart();
    }
    if ( strcmp(topic, (hostname + String("/watchdog")).c_str()) == 0) {
      Serial.print("watchdog ");
      Serial.println(payload);
    }
    if ( strcmp(topic, (hostname + String("/timer")).c_str()) == 0) {
      Serial.print("timer ");
      offtimer = millis();
    }
  }
}

void onMqttPublish(uint16_t packetId) {
    Serial.print("Publish acknowledged.");
  //  Serial.print("  packetId: ");
  //  Serial.println(packetId);
}

void MQTTSend (String topic, String payload) {
  uint8_t Length;
  Length = payload.length();
  mqttClient.publish(topic.c_str(), 1, true, payload.c_str(), Length);
}

void swingControl(char message[]) {
  int function_code = 163;
  int function_value = swingtoint(message);
  int rcv_code = 17;
  send_code(function_code, function_value, rcv_code);
}

void modeControl(char message[]) {
  int function_code = 176;
  int function_value = modetoint(message);
  if (function_value != 0) {
    int rcv_code = 4;
    send_code(function_code, function_value, rcv_code);
  }
}

void fanControl(char message[]) {
  int function_code = 160;
  int function_value = fanmodetoint(message);
  int rcv_code = 20;
  send_code(function_code, function_value, rcv_code);
}

void stateControl(char message[]) {
  int function_code = 128;
  int function_value = statetoint(message);
  int rcv_code = 52;
  send_code(function_code, function_value, rcv_code);
}

void setpointVal(char message[]) {
  int function_code = 179;
  int function_value = atoi(message);
  int rcv_code = 1;
  send_code(function_code, function_value, rcv_code);
}

void doinit() {
  getcode(128, 52); //state
  getcode(176, 4); //on/off
  getcode(179, 1); //setpoint
  getcode(160, 20); //fanmode
  getcode(135, 45); //??
  getcode(163, 17); //swing mode
  getcode(187, 249); //roomtemp
  getcode(190, 246); //out temp
  getcode(203, 233); //??
  getcode(136, 44); //??
  //getcode(134,46);
  getcode(144, 36); //??
  getcode(148, 32); //??
}

void dowatchdog() {
  getcode(187, 249); //roomtemp
  getcode(190, 246); //out temp
  getcode(128, 52); //state
  getcode(176, 4); //on/off
  getcode(179, 1); //setpoint
  getcode(160, 20); //fanmode
  getcode(163, 17); //swing mode
}

void getcode(int function_code, int rcv_code) {
  int getlist[14] = {2, 0, 3, 16, 0, 0, 6, 1, 48, 1, 0, 1, 0, 0};
  getlist[12] = function_code;
  getlist[13] = rcv_code;
  report(getlist, sizeof(getlist) / sizeof(getlist[0]));
  //  delay(100);
}

void send_code(int function_code, int function_value, int rcv_code) {
  int mylist[15] = {2, 0, 3, 16, 0, 0, 7, 1, 48, 1, 0, 2, 0, 0, 0};
  mylist[12] = function_code;
  mylist[13] = function_value;
  mylist[14] = checksum(function_value, function_code);
  report(mylist, sizeof(mylist) / sizeof(mylist[0]));
  getcode(function_code, rcv_code);
}

void report(int msg[], int siz) {
  TelnetStream.print("*O*");
  for (int i = 0; i < siz; i++) {
    Serial2.write(msg[i]);
    Serial.print(msg[i], DEC);
    Serial.print('.');
    TelnetStream.print(msg[i], DEC);
    TelnetStream.print('.');
  }
  Serial.println(' ');
  TelnetStream.println("*O*");
   delay(100);
}

void reboot() {
  switch (TelnetStream.read()) {
    case 'R':
      TelnetStream.stop();
      delay(100);
      ESP.restart();
      break;
  }
}