import network
import time
from machine import Pin
import dht
import ujson
from umqtt.simple import MQTTClient
from hcsr04 import HCSR04
from time import sleep


MQTT_CLIENT_ID = ""
MQTT_BROKER    = "mqtt-dashboard.com"
MQTT_USER      = ""
MQTT_PASSWORD  = ""
MQTT_TOPIC     = "AMIRSAAHAL/Distance"

sensor = HCSR04(trigger_pin=5, echo_pin=18, echo_timeout_us=100000)

print("Connecting to WiFi", end="")
sta_if = network.WLAN(network.STA_IF)
sta_if.active(True)
sta_if.connect('Wokwi-GUEST', '')
while not sta_if.isconnected():
  print(".", end="")
  time.sleep(0.1)
print(" Connected!")

print("Connecting to MQTT server... ", end="")
client = MQTTClient(MQTT_CLIENT_ID, MQTT_BROKER, user=MQTT_USER, password=MQTT_PASSWORD)
client.connect()

print("Connected!")

prev_distance = ""
while True:
  distance = sensor.distance_cm()
  print('Distance:', distance, 'cm')
  sleep(1)

  message = ujson.dumps(distance)
  if message != prev_distance:
    print("Updated!")
    print("Reporting to MQTT topic {}:{} ".format(MQTT_TOPIC, message))
    client.publish(MQTT_TOPIC, message)
    prev_distance = message
  
  else:
    print("No change")
  time.sleep(1)