
# Code for XIAO 0 / ToF board

import board 
import time
from microcontroller import Pin
import  digitalio
import busio
import adafruit_vl53l4cd 

uart = busio.UART(board.TX, board.RX, baudrate=9600, timeout=0.1)

i2c = board.I2C()
vl53 = adafruit_vl53l4cd.VL53L4CD(i2c)

vl53.start_ranging() 

while True:
    while not vl53.data_ready:
        pass
    vl53.clear_interrupt()
    distance =  vl53.distance 
    print(distance)
    if int(distance) < 10:
        uart.write(bytes("2" + str(distance) + "\n", "utf-8"))
    elif int(distance) < 20: 
        uart.write(bytes("1" + str(distance) + "\n", "utf-8"))
        




