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

#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64

int trigPin = 17;
int echoPin = 16;
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, -1);
short val;
long duration;
double distance;

void setup() {
  Serial.begin(115200);
  
  // 設置超聲波引腳
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  
  // 初始化顯示器
  if (!display.begin(SSD1306_SWITCHCAPVCC, 0x3c)) {
    Serial.println(F("SSD1306 初始化失敗"));
    for (;;) ;
  }
  
  delay(200);
  display.clearDisplay();
  display.setTextSize(1);
  display.setTextColor(WHITE);
  display.setCursor(0, 10);
}

void loop() {
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  
  // 測量超聲波回程時間
  duration = pulseIn(echoPin, HIGH);
  
  // 計算距離
  distance = duration * 0.034 / 2;
  
  display.clearDisplay();
  display.setCursor(0, 0);
  display.print("distance:");
  display.setCursor(0, 35);
  display.print(distance);
  display.print("CM");
  
  Serial.print("距離：");
  Serial.print(distance);
  Serial.print("cm");
  
  delay(1000);
  display.display();
}