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

byte trigger = 2;
byte echo = 3;

HCSR04 hc(trigger, echo);
Adafruit_SSD1306 oled(126, 64, &Wire, -1);

void setup()
{
  Wire.begin();
  oled.begin(SSD1306_SWITCHCAPVCC, 0x3C);
  oled.clearDisplay();
  oled.setTextColor(SSD1306_WHITE);
}

void loop()
{
  oled.clearDisplay();
  oled.setCursor(10,10);
  oled.print("Odleglosc to: ");
  oled.setCursor(10, 20);
  oled.print(hc.dist());
  oled.print(" Centymetrow");
  oled.display();
  delay(80);
}