#include <Ultrasonic.h>
#include <Adafruit_SSD1306.h>
#include <Adafruit_GFX.h>

#define pino_trigger 7
#define pino_echo 8

Adafruit_SSD1306 display(128,64,&Wire);

Ultrasonic sensor(pino_trigger,pino_echo);

float medida;


void setup() {
  display.begin(SSD1306_SWITCHCAPVCC,0X3C);  
}

void loop() {
  medida = sensor.read();
  
  display.clearDisplay();
  display.setCursor(12,0);
  display.setTextSize(1);
  display.setTextColor(1);
  display.print("--TRENA DIGITAL--");

  display.drawRoundRect(0,12,128,40,10,WHITE);

  display.setCursor(20,55);
  display.print("Rob");
  display.write(162);
  display.print("tica");
  display.print(" Paran");
  display.write(160);

  display.setTextSize(2);
  if(medida < 100){
    display.setCursor(25,25);
    display.print(medida);
    display.setCursor(85,25);
    display.print("cm");
  }
  
  if(medida > 99){
    display.setCursor(25,25);
    display.print(medida/100);
    display.setCursor(85,25);
    display.print("m");
  }
  
  
  display.display();
  
}