#define OnboradLED 2
#define G 15
#define F 2
#define A 4
#define B 16
#define C 18
#define D 5
#define E 17
#define dp 19


#include <SPI.h>
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>

unsigned long last_time = 0;
void setup() {
  //Serial.begin(115200);
  Serial.begin(19200);
  pinMode(OnboradLED, OUTPUT);
  Serial.println("START Firmware,048,19200");
  
  Serial.println("I2C Scanner - พบอุปกรณ์ที่เชื่อมต่อ:");
  scanI2CDevices();

}

void scanI2CDevices() {
  byte error, address;
  int deviceCount = 0;

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

    if (error == 0) {
      Serial.print("Address 0x");
      if (address < 16) {
        Serial.print("0");
      }
      Serial.print(address, HEX);
      Serial.println(" (เรียบร้อย)");
      deviceCount++;
    }
    else if (error == 4) {
      Serial.print("Address 0x");
      if (address < 16) {
        Serial.print("0");
      }
      Serial.println(address, HEX);
      Serial.println(" (ไม่พบอุปกรณ์)");
    }
  }

  if (deviceCount == 0) {
    Serial.println("ไม่พบอุปกรณ์ที่เชื่อมต่อผ่าน I2C.");
  }
}

void loop() {
  if ( millis() - last_time > 500) {
    digitalWrite(OnboradLED, !digitalRead(2));
    last_time = millis();
  }
}


void a() {
  digitalWrite(A, HIGH);
  digitalWrite(B, HIGH);
  digitalWrite(C, HIGH);
  digitalWrite(D, LOW);
  digitalWrite(E, HIGH);
  digitalWrite(F, HIGH);
  digitalWrite(G, HIGH);
}

void b() {
  digitalWrite(A, LOW);
  digitalWrite(B, LOW);
  digitalWrite(C, HIGH);
  digitalWrite(D, HIGH);
  digitalWrite(E, HIGH);
  digitalWrite(F, HIGH);
  digitalWrite(G, HIGH);
}

void c() {
  digitalWrite(A, HIGH);
  digitalWrite(B, LOW);
  digitalWrite(C, LOW);
  digitalWrite(D, HIGH);
  digitalWrite(E, HIGH);
  digitalWrite(F, HIGH);
  digitalWrite(G, HIGH);
}

void d() {
  digitalWrite(A, LOW);
  digitalWrite(B, HIGH);
  digitalWrite(C, HIGH);
  digitalWrite(D, HIGH);
  digitalWrite(E, HIGH);
  digitalWrite(F, LOW);
  digitalWrite(G, HIGH);
}

void e() {
  digitalWrite(A, HIGH);
  digitalWrite(B, LOW);
  digitalWrite(C, LOW);
  digitalWrite(D, HIGH);
  digitalWrite(E, HIGH);
  digitalWrite(F, HIGH);
  digitalWrite(G, HIGH);
}

void f() {
  digitalWrite(A, HIGH);
  digitalWrite(B, LOW);
  digitalWrite(C, LOW);
  digitalWrite(D, LOW);
  digitalWrite(E, HIGH);
  digitalWrite(F, HIGH);
  digitalWrite(G, HIGH);
}