from machine import Pin, time_pulse_us
from time import sleep

trigger = Pin(28, Pin.OUT)
echo = Pin(27, Pin.IN)

unidade = [
  Pin(1, Pin.OUT), #A
  Pin(2, Pin.OUT), #B
  Pin(3, Pin.OUT), #C
  Pin(4, Pin.OUT), #D
  Pin(5, Pin.OUT), #E
  Pin(6, Pin.OUT), #F
  Pin(7, Pin.OUT), #G
]

dezena = [
  Pin(8, Pin.OUT),  #A
  Pin(9, Pin.OUT),  #B
  Pin(10, Pin.OUT), #C
  Pin(11, Pin.OUT), #D
  Pin(12, Pin.OUT), #E
  Pin(13, Pin.OUT), #F
  Pin(14, Pin.OUT), #G
]

centena = [
  Pin(15, Pin.OUT), #A
  Pin(16, Pin.OUT), #B
  Pin(17, Pin.OUT), #C
  Pin(18, Pin.OUT), #D
  Pin(19, Pin.OUT), #E
  Pin(20, Pin.OUT), #F
  Pin(21, Pin.OUT), #G
]

numeros = [
  [0,0,0,0,0,0,1],  #0
  [1,0,0,1,1,1,1],  #1
  [0,0,1,0,0,1,0],  #2
  [0,0,0,0,1,1,0],  #3
  [1,0,0,1,1,0,0],  #4
  [0,1,0,0,1,0,0],  #5
  [0,1,0,0,0,0,0],  #6
  [0,0,0,1,1,1,1],  #7
  [0,0,0,0,0,0,0],  #8
  [0,0,0,1,1,0,0]   #9
]

while True:
  trigger.value(1)
  trigger.value(0)

  tempo = time_pulse_us(echo, Pin.high)
  distancia = str(round(34000*tempo/(2*1000000)))
  print("distância:", distancia)
  
  for i in range(7):
    for j in range(7):
      for k in range(7):        
        if len(distancia) > 2:  
          c = int(distancia[0])
          d = int(distancia[1])
          u = int(distancia[2])
        elif len(distancia) > 1:
          c = 0
          d = int(distancia[0])
          u = int(distancia[1])
        else:
          c = 0
          d = 0
          u = int(distancia[0])

        unidade[k].value(numeros[u][k])
        dezena[j].value(numeros[d][j])
        centena[i].value(numeros[c][i])     
  sleep(0.5)