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


#define trigPin 10
#define echoPin 13
int Led50 = 6;

#define MAX_DEVICES 1 // DEFINE THE MAXIMUM NUMBER OF DISPLAY
#define CLK_PIN 21 // CLK OR SCK FOR ARUDINO MEGA 
#define DATA_PIN 20 // DATA  pin for arudino mega

#define MAX_DEVICES 1 // DEFINE THE MAXIMUM NUMBER OF DISPLAY
#define CLK_PIN 21 // CLK OR SCK FOR ARUDINO MEGA 
#define DATA_PIN 20 // DATA  pin for arudino mega

#define SCREEN_WIDTH 128 // OLED display width, in pixels
#define SCREEN_HEIGHT 64 // OLED display height, in pixels
#define OLED_RESET     4 // Reset pin # (or -1 if sharing Arduino reset pin)
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);
#define NUMFLAKES     10 // Number of snowflakes in the animation example

#define LOGO_HEIGHT   16
#define LOGO_WIDTH    16
//SSD_1306 is the driver chip of the OLED

static const unsigned char PROGMEM logo_bmp[] =
{ B00000000, B11000000,
  B00000001, B11000000,
  B00000001, B11000000,
  B00000011, B11100000,
  B11110011, B11100000,
  B11111110, B11111000,
  B01111110, B11111111,
  B00110011, B10011111,
  B00011111, B11111100,
  B00001101, B01110000,
  B00011011, B10100000,
  B00111111, B11100000,
  B00111111, B11110000,
  B01111100, B11110000,
  B01110000, B01110000,
  B00000000, B00110000 };

void setup() {
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode (Led50, OUTPUT);
  Serial.begin(9600); //Baud rate bit rate
  // SSD1306_SWITCHCAPVCC = generate display voltage from 3.3V internally
  if(!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) { // Address 0x3D for 128x64
    Serial.println(F("SSD1306 allocation failed"));
    for(;;); // Don't proceed, loop forever
  }

  // Show initial display buffer contents on the screen --
  // the library initializes this with an Adafruit splash screen.
  display.display();
  delay(2000);
  display.clearDisplay();

}

void loop() {
  
  float duration, distance; 			// 8:  Initiallise system
  digitalWrite(trigPin, LOW); 
  delayMicroseconds(2);
 
  digitalWrite(trigPin, HIGH);		// 11:  Start Pulse, 10µs
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
 
  display.setCursor(2,20);
  display.setTextSize(1);
  display.setTextColor(WHITE);
  display.drawPixel(10, 10, SSD1306_WHITE);

  duration = pulseIn(echoPin, HIGH);	// 14:  Duration setup
  distance = (duration / 2) * 0.0344;	// 15:  Distance calculation

 if (distance >=50)
 
   digitalWrite(Led50,HIGH);
   else
   digitalWrite(Led50,LOW);
 
   Serial.print("Distance = ");		// 20:  Valid distance display
   Serial.print(distance);
   Serial.print(" cm");  

  if (distance >= 200) {	// 16:  
    display.setCursor(2,20);
    Serial.println(" Safe!");
    display.print(distance);
    display.print("cm Safe!");

    display.display();
  } else if (distance <= 200 && distance >= 80) {
    display.setCursor(2,20);
    Serial.println(" Careful!");
    display.print(distance);
    display.print("cm Careful!");
   
    display.display();
  } else if (distance < 80) {
    display.setCursor(2,20);
    Serial.println(" Too Close!");
    display.print(distance);
    display.print("cm Too Close!");

    display.display();
  }
   display.drawRect(1, 40, distance/3,display.height() -50, WHITE);

   display.display();
  
        
  delay(500); 
  display.clearDisplay(); 

  
}