from machine import Pin, I2C, PWM
from utime import sleep, sleep_ms
import network, time
import ujson
from umqtt.simple import MQTTClient

servo = PWM(Pin(14), freq=50)

MQTT_CLIENT_ID = "nueva555sbdbdgR"
MQTT_BROKER    = "broker.hivemq.com"
MQTT_USER      = ""
MQTT_PASSWORD  = ""
MQTT_TOPIC_SUB = "control/puerta/casa"

def map_servo(x):        
        return int((x - 0) * (125 - 25) /(180-0)+25)


def conectaWifi (red, password):
      global miRed
      miRed = network.WLAN(network.STA_IF)     
      if not miRed.isconnected():              #Si no está conectado…
          miRed.active(True)                   #activa la interface
          miRed.connect(red, password)         #Intenta conectar con la red
          print('Conectando a la red', red +"…")
          timeout = time.time ()
          while not miRed.isconnected():           #Mientras no se conecte..
              if (time.ticks_diff (time.time (), timeout) > 10):
                  return False
      return True

if conectaWifi("Wokwi-GUEST", ""):

    print ("Conexión exitosa!")
    print('Datos de la red (IP/netmask/gw/DNS):', miRed.ifconfig())

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

    def sub_cb(topic, msg):
        dato = msg.decode()
        print(f'Recibido:{dato}')

        if dato == "Abrir":
            m = map_servo(180)
            servo.duty(m)

        elif dato == "Cerrar":
            m = map_servo(0)
            servo.duty(m)

        elif dato == "Entreabrir":
            m = map_servo(90)
            servo.duty(m)

      
    while True:
           
        client.set_callback(sub_cb)
        client.subscribe(MQTT_TOPIC_SUB)
        print ("esperando")
        client.wait_msg()
        time.sleep(3)