#include <IOXhop_FirebaseESP32.h>

#include <WiFi.h>
#include <M5StickC.h>

#define FIREBASE_DB_URL "XXXX.firebaseio.com"
#define FIREBASE_DB_AUTH "XXXXXXXXXXXXXXXXXXXXXXXXX"
#define FIREBASE_DB_DATA "/message"

#define WIFI_SSID "XXXXX"
#define WIFI_PASSWORD "XXXXX"


// ブリッジ制御
#define M_STANBY  B00   // スタンバイ   
#define M_REVERSE B01   // 逆転
#define M_NORMAL  B10   // 正転
#define M_BRAKE   B11   // ブレーキ

const bool ONLINE = true;//オンラインモード
const int DRV8830 = 0x60;


int changeFlag = true;//値変更時だけtrue
int dir = 0; //進行方向 0:停止 1:正転 2:逆転
byte vset = 0x21;
boolean atfst = true;

void writeResister(byte vset, byte data1) {
  int vdata = vset << 2 | data1;
  Wire.beginTransmission(DRV8830);
  Wire.write(0x00);
  //Wire.write(vset);
  Wire.write(vdata);
  Wire.endTransmission(true);
}

void setup() {
  M5.begin();
  // put your setup code here, to run once:
  Serial.begin(115200);
  Wire.begin(0, 26); //SDA, SCL
  Serial.println("Standby");
  writeResister(0x00, 0x00);
  delay(500);

  //WIFI セットアップ
  if (ONLINE) {
    WiFi.mode(WIFI_STA);
    WiFi.disconnect(true);
    delay(1000);
    WiFi.begin(WIFI_SSID, WIFI_PASSWORD);
    Serial.println("connecting");

    while (WiFi.status() != WL_CONNECTED) {
      Serial.print(".");
      delay(500);
      Serial.print(WiFi.status());
      Serial.print(",");
    }
    Serial.println();
    Serial.print("connected: ");
    Serial.println(WiFi.localIP());
    delay(500);
  }

  Firebase.begin(FIREBASE_DB_URL, FIREBASE_DB_AUTH);

  Firebase.stream(FIREBASE_DB_DATA, [](FirebaseStream stream) {
    String eventType = stream.getEvent();
    eventType.toLowerCase();
    Serial.print("event: ");
    Serial.println(eventType);
    if (atfst) {
      atfst = false;
    } else if (eventType == "put") {
      int data = stream.getDataInt();
      Serial.print("data: ");
      Serial.println(data);
      changeFlag = true;
      dir = data;
    }
  });
}


void loop() {
  // put your main code here, to run repeatedly:

  byte v;
  if (changeFlag) {
    writeResister(0x00, 0x00
    );
    delay(500);
    if (dir == 0) {
      v = 0x00;
    } else {
      v = vset;
    }
    writeResister(v, byte(dir));
    changeFlag = false;
  }
}