#include <ESP8266WiFi.h>
#include "Adafruit_MQTT.h"
#include "Adafruit_MQTT_Client.h"

//サーボモーターを制御するためのライブラリをインクルード
#include <Servo.h>

//WIFI定義
#define WIFI_SSID "SSID"
#define WIFI_PASS "*********"
#define MQTT_SERV "io.adafruit.com"
#define MQTT_PORT 1883
#define MQTT_NAME "USERNAME"
#define MQTT_PASS "PASS***"

//任意のサーボモータークラスを用意。
Servo servo1; 
int val;
int state=0;
int led = D7;

//MQTTの設定
WiFiClient client;
Adafruit_MQTT_Client mqtt(&client, MQTT_SERV, MQTT_PORT, MQTT_NAME, MQTT_PASS);
Adafruit_MQTT_Subscribe onoff = Adafruit_MQTT_Subscribe(&mqtt, MQTT_NAME "/f/onoff");
Adafruit_MQTT_Publish LightsStatus = Adafruit_MQTT_Publish(&mqtt, MQTT_NAME "/f/LightsStatus");

//初期セットアップ
void setup()
{
  //COMのシリアルスピード設定
  Serial.begin(9600);

   //デジタル4番ピンをサーボモーターの出力ピンとして設定
  servo1.attach(4);
   servo1.write(150);
   pinMode(14,OUTPUT);//LED


  //WIFIに接続する
  Serial.print("\n\nConnecting Wifi>");
  WiFi.begin(WIFI_SSID, WIFI_PASS);
  digitalWrite(LED_BUILTIN, LOW);

  while (WiFi.status() != WL_CONNECTED)
  {
    Serial.print(">");
    delay(50);
  }

//接続できたとき
  Serial.println("OK!");

  //onoffへ要求を出します。
  mqtt.subscribe(&onoff);
}

//サーボ定義（オン）の時
void on(void){
  //スイッチを消すときの処理
  servo1.write(200);
  delay(500);
servo1.write(150);

  }

//サーボ定義（オフ）の時
void off(void){
  //つけるときの処理
    servo1.write(150);
  delay(500);
servo1.write(90);
 delay (500);
 servo1.write(150);
  }


//ループ処理
void loop()
{
  //MQTTに接続する
  MQTT_connect();

  //不足するまでサブスクリプションキューから読み取る
  //サブスクリプションが更新されるまで最大5秒間待機
  Adafruit_MQTT_Subscribe * subscription;
  while ((subscription = mqtt.readSubscription(5000)))
  {
    //要求が完了したか判定
    if (subscription == &onoff)
    {
      //更新値をシリアルモニタに表示
      Serial.print("onoff: ");
      Serial.println((char*) onoff.lastread);

      //更新値が "ON"の場合は、ライトを点灯
      //それ以外の場合はオフに
      if (!strcmp((char*) onoff.lastread, "ON"))
      {
        //点灯   
   　　　on();
        LightsStatus.publish("ON");
      }
      else if (!strcmp((char*) onoff.lastread, "OFF"))
      {
　　　　//消灯
　　　　 off();
        LightsStatus.publish("OFF");

      }
      else
      {
        LightsStatus.publish("ERROR");
      }
    }
    else
    {
      //LightsStatus.publish("ERROR");
    }

  }

  //テスト
  //  if (!mqtt.ping())
  //  {
  //    mqtt.disconnect();
  //  }
}



void MQTT_connect()
{

  // Stop if already connected
  if (mqtt.connected() && mqtt.ping())
  {
    //    mqtt.disconnect();
    return;
  }

  int8_t ret;

  mqtt.disconnect();

  Serial.print("Connecting to MQTT... ");
  uint8_t retries = 3;
  while ((ret = mqtt.connect()) != 0) // connect will return 0 for connected
  {
    Serial.println(mqtt.connectErrorString(ret));
    Serial.println("Retrying MQTT connection in 5 seconds...");
    mqtt.disconnect();
    delay(5000);  // wait 5 seconds
    retries--;
    if (retries == 0)
    {
      ESP.reset();
    }
  }
  Serial.println("MQTT Connected!");
}