from machine import Pin, ADC
import ujson
import network
import utime as time
import dht
import urequests as requests

# Konfigurasi Ultrasonik HC-SR04
TRIG_PIN = Pin(2, Pin.OUT)
ECHO_PIN = Pin(4, Pin.IN)

def measure_distance():
    TRIG_PIN.off()
    time.sleep_us(2)
    TRIG_PIN.on()
    time.sleep_us(10)
    TRIG_PIN.off()
    
    pulse_start = pulse_end = 0
    while ECHO_PIN.value() == 0:
        pulse_start = time.ticks_us()
    while ECHO_PIN.value() == 1:
        pulse_end = time.ticks_us()
    
    duration = pulse_end - pulse_start
    distance = (duration * 0.0343) / 2  # Konversi ke cm
    return max(distance, 0)  # Hindari nilai negatif

DEVICE_ID = "esp32-sic6"
WIFI_SSID = "Wokwi-GUEST"
WIFI_PASSWORD = ""
TOKEN = "BBUS-Srav7xe0WzwUVjz0qJykIjvYR0WJFs"
DHT_PIN = Pin(15)

def create_json_data(temperature, humidity, distance):
    data = ujson.dumps({
        "device_id": DEVICE_ID,
        "temp": temperature,
        "humidity": humidity,
        "distance": distance,
        "type": "sensor"
    })
    return data

def send_data(temperature, humidity, distance):
    url = "http://industrial.api.ubidots.com/api/v1.6/devices/" + DEVICE_ID
    headers = {"Content-Type": "application/json", "X-Auth-Token": TOKEN}
    data = {
        "temp": temperature,
        "humidity": humidity,
        "distance": distance
    }
    try:
        response = requests.post(url, json=data, headers=headers)
        print("Done Sending Data!")
        print("Response:", response.text)
    except Exception as e:
        print("Error sending data:", e)

wifi_client = network.WLAN(network.STA_IF)
wifi_client.active(True)
print("Connecting device to WiFi")
wifi_client.connect(WIFI_SSID, WIFI_PASSWORD)

while not wifi_client.isconnected():
    print("Connecting")
    time.sleep(0.1)
print("WiFi Connected!")
print(wifi_client.ifconfig())

dht_sensor = dht.DHT22(DHT_PIN)

time.sleep(1)  # Beri waktu untuk stabilisasi sensor

while True:
    try:
        dht_sensor.measure()
        temperature = dht_sensor.temperature()
        humidity = dht_sensor.humidity()
        distance = measure_distance()
    except Exception as e:
        print("Error reading sensors:", e)
        temperature = humidity = distance = -1  # Nilai default jika terjadi error
    
    time.sleep(0.5)
    telemetry_data_new = create_json_data(temperature, humidity, distance)
    send_data(temperature, humidity, distance)
    time.sleep(5)