unsigned long last_time1 = 0;
unsigned long last_time2 = 0;
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#define SW1 32
#define SW2 33
hw_timer_t *My_timer = NULL;

int state_led = 0;

void IRAM_ATTR onTimer(){
  if((digitalRead(SW1)==1) && (digitalRead(SW2)==1)){
    digitalWrite(25, !digitalRead(25));
    Serial.printf("BLINK");
  }
  if((digitalRead(SW1)==0) && (digitalRead(SW2)==0)){

     if((state_led == 1)|| (state_led == 2 )|| (state_led == 3)||(state_led == 4) ){
      digitalWrite(25, HIGH);
    }else if((state_led == 5)|| (state_led == 6)|| (state_led ==7 )|| (state_led == 8)){
      digitalWrite(25, LOW);
    }
    state_led++;
    if(state_led >= 8){
      state_led = 0;
    }

  }
  

}
void setup() {
  pinMode(2, OUTPUT);
  Wire.begin();
  Serial.begin(38400);
  while (!Serial);
  Serial.println("START Firmware 099");
  pinMode(25, OUTPUT);
  pinMode(SW1, INPUT_PULLUP);
  pinMode(SW2, INPUT_PULLUP);
  My_timer = timerBegin(0,80,true);
  timerAttachInterrupt(My_timer,&onTimer,true);
  timerAlarmWrite(My_timer,500000,true);
  timerAlarmEnable(My_timer);

}

void loop() {
  
 
    if (millis() - last_time1 >= 2000) {
      digitalWrite(2, !digitalRead(2));

      last_time1 = millis();
      byte error, address;
      int nDevices;
      Serial.println("Scanning...");
      nDevices = 0;

      for (address = 1; address < 127; address++) {
        Wire.beginTransmission(address);
        error = Wire.endTransmission();

        if (error == 0) {
          Serial.print("I2C device found at address 0x");

          if (address < 16)
            Serial.print("0");
          Serial.print(address, HEX);
          Serial.println(" !");
          nDevices++;
        } 
        
        else if (error == 4) {
          Serial.print("Unknown error at address 0x");
        
          if (address < 16)
            Serial.print("0");
          Serial.println(address, HEX);
        }
      }
      
      if (nDevices == 0)
        Serial.println("No I2C devices found\n");
      
      else
        Serial.println("done\n");
      delay(1000);


      }

}