#include "ESP32Wiimote.h"
#define LED 2
ESP32Wiimote wiimote;
int i=1;
void setup(){
    Serial.begin(115200);
    Serial.println("Wiimote Start");
    pinMode(LED, OUTPUT);
    wiimote.init();
    wiimote.addFilter(ACTION_IGNORE, FILTER_NUNCHUK_ACCEL);
}

void loop(){
  wiimote.task();
  if (wiimote.available() > 0) {
      uint16_t button = wiimote.getButtonState();
      Serial.printf("%04x\n", button);
      if (button == ESP32Wiimote::BUTTON_A) {
        Serial.println("A button ON");
        if (digitalRead(LED)) {
          digitalWrite(LED, LOW); 
        } else {
          digitalWrite(LED, HIGH); 
        }
      } else if (button == ESP32Wiimote::BUTTON_PLUS) {
        Serial.println("PLUS button ON");
        i++;if (i>15) i=0;
        wiimote.setLEDs(i);

      } else if (button == ESP32Wiimote::BUTTON_MINUS) {
        Serial.println("MINUS button ON");
        i--;if (i<0) i=15;
        wiimote.setLEDs(i);

      } else if (button == ESP32Wiimote::BUTTON_HOME) {
        Serial.println("HOME button ON");
        wiimote.setLEDs(0);
        i=0;
       }

/*    ヌンチャクを試験する時は、コメントを取る 
      NunchukState nunchuk = wiimote.getNunchukState();
      Serial.printf("nunchuk:");
      Serial.printf(" X-Stick: %d", nunchuk.xStick);
      Serial.printf(" Y-Stick: %d", nunchuk.yStick);
      Serial.printf(" X-Axis: %d", nunchuk.xAxis);
      Serial.printf(" Y-Axis: %d", nunchuk.yAxis);
      Serial.printf(" Z-Axis: %d", nunchuk.zAxis);
      Serial.printf(" C-Button: %02x", nunchuk.cBtn);
      Serial.printf(" Z-Button: %02x", nunchuk.zBtn);
      Serial.printf("\n");
*/      
  }
  delay(10);
}