#include <TM1637.h>
//Display
uint8_t DIO = 2;
uint8_t CLK = 3;
TM1637 tmDisplay(CLK, DIO);

//sensor ultrasónico
uint8_t EcoPin = 4;
uint8_t TrigPin = 5; 
unsigned long duration; 
unsigned long distance;

void setup() {
  // put your setup code here, to run once:
  tmDisplay.init();
  tmDisplay.set( BRIGHT_TYPICAL);
  pinMode(EcoPin, INPUT);
  pinMode(TrigPin, OUTPUT);

}

void loop() {
  // put your main code here, to run repeatedly:
  digitalWrite(TrigPin, LOW);
  delayMicroseconds(5);
  digitalWrite(TrigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(TrigPin, LOW);

  duration = pulseIn(EcoPin, HIGH);
  distance = (duration/58.2);

  displayDistance(distance);
  delay(500);
}

void displayDistance(unsigned long distance){
  if(distance >= 0 && distance<= 9999){
    tmDisplay.display(0, distance/1000);
    tmDisplay.display(1, (distance % 1000)/100);
    tmDisplay.display(2, (distance % 100)/10);
    tmDisplay.display(3, (distance % 10));
  } else {
    tmDisplay.display(0, 10);
    tmDisplay.display(1, 10);
    tmDisplay.display(2, 10);
    tmDisplay.display(3, 10);
  }

}