MCH2022 badge?
go to mch2022.badge.team

Content import usocket as socket import ustruct as struct class MQTTException(Exception): pass class MQTTClient: def __init__(self, client_id, server, port=0, user=None, password=None, keepalive=0, ssl=False, ssl_params={}): if port == 0: port = 8883 if ssl else 1883 self.client_id = client_id self.sock = None self.server = server self.port = port self.ssl = ssl self.ssl_params = ssl_params self.pid = 0 self.cb = None self.user = user if user != '' else None self.pswd = password if password != '' else None self.keepalive = keepalive self.lw_topic = None self.lw_msg = None self.lw_qos = 0 self.lw_retain = False def _send_str(self, s): self.sock.write(struct.pack("!H", len(s))) self.sock.write(s) def _recv_len(self): n = 0 sh = 0 while 1: b = self.sock.read(1)[0] n |= (b & 0x7f) << sh if not b & 0x80: return n sh += 7 def set_callback(self, f): self.cb = f def set_last_will(self, topic, msg, retain=False, qos=0): assert 0 <= qos <= 2 assert topic self.lw_topic = topic self.lw_msg = msg self.lw_qos = qos self.lw_retain = retain def connect(self, clean_session=True): self.sock = socket.socket() addr = socket.getaddrinfo(self.server, self.port)[0][-1] self.sock.connect(addr) if self.ssl: import ussl self.sock = ussl.wrap_socket(self.sock, **self.ssl_params) premsg = bytearray(b"\x10\0\0\0\0\0") msg = bytearray(b"\x04MQTT\x04\x02\0\0") sz = 10 + 2 + len(self.client_id) msg[6] = clean_session << 1 if self.user is not None: sz += 2 + len(self.user) + 2 + len(self.pswd) msg[6] |= 0xC0 if self.keepalive: assert self.keepalive < 65536 msg[7] |= self.keepalive >> 8 msg[8] |= self.keepalive & 0x00FF if self.lw_topic: sz += 2 + len(self.lw_topic) + 2 + len(self.lw_msg) msg[6] |= 0x4 | (self.lw_qos & 0x1) << 3 | (self.lw_qos & 0x2) << 3 msg[6] |= self.lw_retain << 5 i = 1 while sz > 0x7f: premsg[i] = (sz & 0x7f) | 0x80 sz >>= 7 i += 1 premsg[i] = sz self.sock.write(premsg, i + 2) self.sock.write(msg) self._send_str(self.client_id) if self.lw_topic: self._send_str(self.lw_topic) self._send_str(self.lw_msg) if self.user is not None: self._send_str(self.user) self._send_str(self.pswd) resp = self.sock.read(4) assert resp[0] == 0x20 and resp[1] == 0x02 if resp[3] != 0: raise MQTTException(resp[3]) return resp[2] & 1 def disconnect(self): self.sock.write(b"\xe0\0") self.sock.close() def ping(self): self.sock.write(b"\xc0\0") def subscribe(self, topic, qos=0): assert self.cb is not None, "Subscribe callback is not set" pkt = bytearray(b"\x82\0\0\0") self.pid += 1 struct.pack_into("!BH", pkt, 1, 2 + 2 + len(topic) + 1, self.pid) self.sock.write(pkt) self._send_str(topic) self.sock.write(qos.to_bytes(1, "little")) while 1: op = self.wait_msg() if op == 0x90: resp = self.sock.read(4) #print(resp) assert resp[1] == pkt[2] and resp[2] == pkt[3] if resp[3] == 0x80: raise MQTTException(resp[3]) return def wait_msg(self): res = self.sock.read(1) self.sock.setblocking(True) if res is None: return None if res == b"": raise OSError(-1) if res == b"\xd0": # PINGRESP sz = self.sock.read(1)[0] assert sz == 0 return None op = res[0] if op & 0xf0 != 0x30: return op sz = self._recv_len() topic_len = self.sock.read(2) topic_len = (topic_len[0] << 8) | topic_len[1] topic = self.sock.read(topic_len) sz -= topic_len + 2 if op & 6: pid = self.sock.read(2) pid = pid[0] << 8 | pid[1] sz -= 2 msg = self.sock.read(sz) self.cb(topic, msg) if op & 6 == 2: pkt = bytearray(b"\x40\x02\0\0") struct.pack_into("!H", pkt, 2, pid) self.sock.write(pkt) elif op & 6 == 4: assert 0 # Checks whether a pending message from server is available. # If not, returns immediately with None. Otherwise, does # the same processing as wait_msg. def check_msg(self): self.sock.setblocking(False) return self.wait_msg() import uinterface import rgb def mqtt_cb(topic, msg): print("New MQTT msg") rgb.clear() msgstr = msg.decode() if len(msgstr) > 5: uinterface.skippabletext(msgstr) else: rgb.text(msgstr) uinterface.connect_wifi() import valuestore settings = valuestore.load('mqttclient', 'settings') if settings is None: settings = { "client_id": "badge" } if "mqtt_server" not in settings: uinterface.skippabletext("Specify MQTT host") settings["mqtt_server"] = uinterface.text_input("abcdefghijklmnopqrstuvwxzy.012345679") valuestore.save('mqttclient', 'settings', settings) if "user" not in settings: uinterface.skippabletext("Specify MQTT user (can be empty)") settings["user"] = uinterface.text_input() valuestore.save('mqttclient', 'settings', settings) if "password" not in settings: uinterface.skippabletext("Specify MQTT password (can be empty)") settings["password"] = uinterface.text_input() valuestore.save('mqttclient', 'settings', settings) if "brightness" in settings: rgb.setbrightness(settings["brightness"]) client_id = settings['client_id'] try: mqttc = MQTTClient(client_id, settings["mqtt_server"], user=settings["user"], password=settings["password"]) mqttc.set_callback(mqtt_cb) mqttc.connect() except: # Maybe wrong hostname del settings["mqtt_server"] valuestore.save('mqttclient', 'settings', settings) # Might be something different, rethrow to restart... raise #status = client_id + "/status" topic = client_id + "/text" mqttc.subscribe(topic) print('Connected to MQTT server!') def check_mqtt_messages(): mqttc.check_msg() return 200 import virtualtimers virtualtimers.begin(200) virtualtimers.new(0, check_mqtt_messages) uinterface.skippabletext("Publish messages to topic " + topic)