#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#define screen_WIDTH 128
#define screen_HEIGHT 64 

Adafruit_SSD1360 display (screen_WIDTH, screen_HEIGHT, &Wire, -1)

// กำหนด pin ของ SR04
const int trigPin = 2; // trigpin ใช้ขา GPI02 หรือ D2
const int echoPin = 4; // echo    ใช้ขา GPI04 หรือ D4


//กำหนดค่าความเร็วของเสียงในอากาศหน่วยเป็น เซนติเมตร/ไมโครเซค
#define SOUND_VELOCITY 0.034
#define CM_TO_INCH 0.393701 

long duration;
float distanceCm;
float distanceInch;


void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200); //ตั้งค่าความเร็วในการสื่อสารของ serial moitor
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);

if(display.begin(SSD1306_SWITCHCAPVCC, 0x3c));{
  Serial.println(F("SSD1306 all0cation failed"));
  for(;;);
}
delay(500);
display.clearDisplay();
display.setTextcolor(WHITE);
}

void loop() {
  // Clears the trigPin
  digitalWrite(trigPin, LOW); 
  delayMicroseconds(2);
  //ให้ trigPin มีสถานะเป็น High 10 micro seconds
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);

  digitalWrite(trigPin, LOW);

 // อ่านค่าที่ขา echoPin ค่าของเวลาในการเดินทางจากการสะท้องกลับของ
 // โดยมีหน่วยเป็น ไมโครเซค (micro seconds)

  duration = pulseIn(echoPin, HIGH);

  //คำนวณระยะทาง
  distanceCm = duration * SOUND_VELOCITY/2;

 //แปลงหน่วยจากเซนติเมตรเป็นนิ้ว
  distanceInch = distanceCm * CM_TO_INCH;

 //ปริ้นค่าระยะทางออกทาง serial Monitor
  Serial.print("Distance (cm): ");
  Serial.println(distanceCm);
  Serial.print("Distance (inch) ");
  Serial.println(distanceInch);
  delay(1000);

  display.clearDisplay();
  display.setCursor(2,0);
  display.setTextSize(1);
  display.setTextcplor(WHITE);
  display.println("Distance:");

  display.setCursor(30, 15);
  display.setTextSize(3);
  display.println(distanceCm);

  display.setCursor(90, 35);
  display.setTextSize(2);
  display.print("cm.");

  display.setCursor(5, 55);
  display.setTextSize(1);
  display.print("NIPAPORN");

  
}