//導入函示庫
#include <Ultrasonic.h>
#include <SPI.h> 
#include <Wire.h> 
#include <Adafruit_GFX.h> 
#include <Adafruit_SSD1306.h> 

#define SCREEN_WIDTH 128 // OLED 寬度像素
#define SCREEN_HEIGHT 64 // OLED 高度像素

// 設定OLED
#define OLED_RESET     -1 // Reset pin # (or -1 if sharing Arduino reset pin)
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);

//設定HC-SR04(超音波)腳位
Ultrasonic ultrasonic(13, 12);

int distance,Left,Right;//定義變數

void setup() {
  Serial.begin(9600);//設定鮑率

  // 偵測是否安裝好OLED了
  if(!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) { // 一般1306 OLED的位址都是0x3C
    Serial.println(F("SSD1306 allocation failed"));
    for(;;); // Don't proceed, loop forever
  }
  display.clearDisplay(); // 清除畫面
  display.setTextSize(2);          // 設定文字大小
  display.setTextColor(1);         // 1:OLED預設的顏色(這個會依該OLED的顏色來決定)
  display.setCursor(5,0);          // 設定起始座標
  display.print("Hello OLED");     // 要顯示的字串
  display.display();               // 要有這行才會把文字顯示出來
  delay(1000);
}

void loop() {
  Left = digitalRead(7);
  Right = digitalRead(8);
  distance = ultrasonic.read();
  if(Left == 1 && Right == 1){//當左右光敏電阻都測到黑線時
    display.clearDisplay(); // 清除畫面
    display.setCursor(0,0);          // 設定起始座標
    display.print("Left:100");     // 要顯示的字串
    display.setCursor(0,20);          // 設定起始座標
    display.print("Right:100");     // 要顯示的字串
    display.display();               // 要有這行才會把文字顯示出來
  }else if(Left == 1){//當左光敏電阻都測到黑線時
    display.clearDisplay(); // 清除畫面
    display.setCursor(0,0);          // 設定起始座標
    display.print("Left:0");     // 要顯示的字串
    display.setCursor(0,20);          // 設定起始座標
    display.print("Right:100");     // 要顯示的字串
    display.display();   
  }else if(Right == 1){//當右光敏電阻都測到黑線時
    display.clearDisplay(); // 清除畫面
    display.setCursor(0,0);          // 設定起始座標
    display.print("Left:100");     // 要顯示的字串
    display.setCursor(0,20);          // 設定起始座標
    display.print("Right:0");     // 要顯示的字串
    display.display();   
  }
  Serial.print("Left:");
  Serial.print(Left);
  Serial.println();
  Serial.print("Right:");
  Serial.print(Right);
  Serial.println();
  delay(1000);

}