#include <M5StickC.h>

// グローバル変数の設定
float gyroCurtX, gyroCurtY, gyroCurtZ;  // ジャイロ値

// 関数宣言
void currentGyro();

void setup() {
  M5.begin();
  M5.MPU6886.Init();
}

void loop() {
  currentGyro();
  delay(500);     // 0.5秒間隔でloopさせる
}

void currentGyro() { // ジャイロ値を計算し表示する関数
  float gyroRawX, gyroRawY, gyroRawZ; // ジャイロ生データ
  M5.MPU6886.getGyroData(&gyroRawX, &gyroRawY, &gyroRawZ);

  gyroCurtX = gyroRawX * M5.MPU6886.gRes;
  gyroCurtY = gyroRawY * M5.MPU6886.gRes;
  gyroCurtZ = gyroRawZ * M5.MPU6886.gRes;

  M5.Lcd.setCursor(0, 30);
  M5.Lcd.printf("Gyro\nX: %7.2f\nY: %7.2f\nZ: %7.2f\n          mg",
                gyroCurtX, gyroCurtY, gyroCurtZ);
}

// MQTT 設定 (subscriber:ThingSpeak)
const char mqttUserName[] = "M5stickC_Gyro";
const char mqttPass[] = "HOGEAHOGEAHOGEAB";
const char writeApiKey[] = "HUGAAHUGAAHUGAB";
const long channelID = 000000;

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

// WiFi 設定
const char ssid[] = "yourssid";         // yourssid→使うWiFiのSSIDに書き換える
const char password[] = "yourwifissid"; // yourwifissid→使うWiFiのパスワードに書き換える
WiFiClient wifiClient;

// MQTT 設定 (subscriber:ThingSpeak)
const char mqttUserName[] = "name";   // name→設定した名前に書き換える
const char mqttPass[] = "pass";       // pass→設定されたmqttパスに書き換える
const char writeApiKey[] = "apikey";  // apikey→設定されたwriteAPIキーに書き換える
const long channelID = 000000;        // 000000→設定されたチャネルIDに書き換える

static const char alphanum[] ="0123456789"
                              "ABCDEFGHIJKLMNOPQRSTUVWXYZ"
                              "abcdefghijklmnopqrstuvwxyz";  // クライアントIDをランダム生成するための文字列

PubSubClient mqttClient(wifiClient);
const char* server = "mqtt.thingspeak.com";

unsigned long lastConnectionTime = 0; 
const unsigned long postingInterval = 10L * 1000L; // Publish の間隔を10秒にする

// グローバル変数の設定
float gyroCurtX, gyroCurtY, gyroCurtZ;  // ジャイロ値

// 関数宣言
void currentGyro();
void reConnect();
void mqttPublish();

void setup() {
  M5.begin();
  M5.MPU6886.Init();

  WiFi.begin(ssid, password);
  while (WiFi.status() != WL_CONNECTED) {
    Serial.print(".");
    delay(500);
  }

  mqttClient.setServer(server, 1883); 
}

void loop() {
  reConnect();

  mqttClient.loop();

  // 最後に Publish した時間から postingInterval が経過すると動作する
  if (millis() - lastConnectionTime > postingInterval) {
    currentGyro();
    mqttPublish();
  }
}


/* 
 * ----- 以下loop内で用いる関数 -----
 */
void currentGyro() { // ジャイロ値を計算し表示する関数
  float gyroRawX, gyroRawY, gyroRawZ; // ジャイロ生データ
  M5.MPU6886.getGyroData(&gyroRawX, &gyroRawY, &gyroRawZ);

  gyroCurtX = gyroRawX * M5.MPU6886.gRes;
  gyroCurtY = gyroRawY * M5.MPU6886.gRes;
  gyroCurtZ = gyroRawZ * M5.MPU6886.gRes;

  M5.Lcd.setCursor(0, 30);
  M5.Lcd.printf("Gyro\nX: %7.2f\nY: %7.2f\nZ: %7.2f\n          mg",
                gyroCurtX, gyroCurtY, gyroCurtZ);
}

void reConnect() { // 接続が切れた際に再接続する
  char clientID[10];

  // 接続まで繰り返す
  while (!mqttClient.connected()) {
    Serial.print("Attempting MQTT connection...");
    // Generate ClientID
    for (int i = 0; i < 8; i++) {
        clientID[i] = alphanum[random(51)];
    }

    // MQTT broker に接続する
    if (mqttClient.connect(clientID,mqttUserName,mqttPass)) {
      Serial.print("Connected with Client ID:  ");
      Serial.print(String(clientID));
      Serial.print(", Username: ");
      Serial.print(mqttUserName);
      Serial.print(" , Passwword: ");
      Serial.println(mqttPass);
    }
    else {
      Serial.print("failed, rc=");
      // http://pubsubclient.knolleary.net/api.html#state に state 一覧が書いてある
      Serial.print(mqttClient.state());
      Serial.println("try again in 5 seconds");
      delay(5000);
    }
  }
}

void mqttPublish() {
  // ThingSpeak に Publish するための文字列データを作成する
  String data = ("field1=" + String(gyroCurtX) + "&field2=" + String(gyroCurtY) + "&field3=" + String(gyroCurtZ));

  int length = data.length();
  char msgBuffer[length];
  data.toCharArray(msgBuffer,length+1);

  // topic 文字列を作成し ThingSpeak の channel feed にデータを Publish する
  String topicString ="channels/" + String(channelID) + "/publish/" + String(writeApiKey);
  length = topicString.length();
  char topicBuffer[length];
  topicString.toCharArray(topicBuffer, length+1);
  mqttClient.publish(topicBuffer, msgBuffer);

  lastConnectionTime = millis(); // 最後に Publish した時間からのカウント
}

void mqttPublish() {
  // ThingSpeak に Publish するための文字列データを作成する
  String data = ("field1=" + String(gyroCurtX) + "&field2=" + String(gyroCurtY) + "&field3=" + String(gyroCurtZ));