diff --git a/orbs/main.py b/orbs/main.py new file mode 100644 index 0000000..1fe5929 --- /dev/null +++ b/orbs/main.py @@ -0,0 +1,144 @@ +___name___ = "Orbs Game" +___license___ = "MIT" +___dependencies___ = ["app", "dialogs", "sim800", "ugfx_helper"] +___categories___ = ["Games"] +___bootstrapped___ = True + +from app import * +from dialogs import * +import utime +import ugfx +import ugfx_helper +from orbs.umqtt.simple import MQTTClient +import network +from machine import mem32 +wlan=network.WLAN() +if not wlan.isconnected(): + import wifi + wifi.connect() + +ugfx_helper.init() +ugfx.clear() +broker='151.216.207.139' +mqtt_username='orbs' +mqtt_password='orbs123' +scoretext="" + +MACAddress=str(mem32[0x400fef20]) + str(mem32[0x400fef24]) + str(mem32[0x400fef28]) + str(mem32[0x400fef2C]) +regOK=False +regFAILED=False + +def mqtt_connect(): + client = MQTTClient(MACAddress,broker, user=mqtt_username, password=mqtt_password) + client.set_callback(sub_cb) + connected=False + try: + client.connect() + connected=True + except Exception as err: + connected=False + if (connected): + return client + else: + return False + +def sub_cb(topic,msg): + global regOK + global regFAILED + global scoretext + try: + (t1,t2,t3,targetBadge,messageType)=topic.decode('utf-8').split('/') + strmsg=msg.decode('utf-8') + if messageType=="regok": + regOK=True + if messageType=="regerror": + regFAILED=True + if messageType=="scores": + scoretext=msg + except: + return + + +def update_token(token): + lb=open("token.txt","w") + lb.write(token) + lb.close() + +def do_gettoken(): + notice("Enter your RFID token ID digits only. Get it right!", title="Orbs Game") + token=prompt_text("Enter token:") + if len(token)==8 or len(token)==14 or len(token)==20: + return token + else: + notice("Invalid token", title="Orbs Game") + return "" + +def do_register(client): + playername=prompt_text("Enter name:") + playername=playername.replace(",",".") + regOK==False + regFAILED==False + if len(playername)>3: + client.publish("/registration/from/" + MACAddress + "/name",mytoken + "," + playername) + notice("Name request sent") + client.check_msg() + if regOK==True: + notice("Registration completed") + if regFAILED==True: + notice("Registration failed") + else: + notice("Name too short") + +def get_token(): + try: + lb=open("token.txt","r") + token=lb.readline() + lb.close() + if token=="": + token=do_gettoken() + except: + token="" + if token=="": + token=do_gettoken() + return token + +def do_showscores(client): + client.publish("/registration/from/" + MACAddress + "/score",mytoken) + notice("Requested scores") + client.check_msg() + if len(scoretext)>0: + (playername,playerscore,rank,redscore,greenscore,bluescore)=scoretext.decode('utf-8').split(',') + notice("Player: " + playername + chr(13) + "Score: " + playerscore + chr(13) + "Rank: " + rank) + notice("Red Score: " + redscore + chr(13) + "Green Score: " + greenscore + chr(13) + "Blue Score: " + bluescore) + else: + notice("Failed to get scores") + +mqttclient=mqtt_connect() +while (not mqttclient): + utime.sleep(2) + mqttclient=mqtt_connect() +mqttclient.subscribe(topic='/badge/to/' + MACAddress + '/#') +#mqttclient.subscribe(topic='/scoreboard/to/all/#') +mytoken=get_token() +if len(mytoken)==0: + notice("Token required",title="Orbs Game") + try: + mqttclient.close() + except: + restart_to_default() + restart_to_default() +update_token(mytoken) + + +menuset = [] +menuset.append({ "title" : "Register", "index" : 1 }) +menuset.append({ "title" : "Scores", "index" : 2 }) + +while True: + selection = prompt_option(menuset, text="Orbs Game", select_text="Select", none_text="Exit") + if (not selection): + restart_to_default() + elif (selection["index"]==1): + do_register(mqttclient) + elif (selection["index"]==2): + do_showscores(mqttclient) diff --git a/orbs/umqtt/robust.py b/orbs/umqtt/robust.py new file mode 100644 index 0000000..7ee40e0 --- /dev/null +++ b/orbs/umqtt/robust.py @@ -0,0 +1,43 @@ +import utime +from . import simple + +class MQTTClient(simple.MQTTClient): + + DELAY = 2 + DEBUG = False + + def delay(self, i): + utime.sleep(self.DELAY) + + def log(self, in_reconnect, e): + if self.DEBUG: + if in_reconnect: + print("mqtt reconnect: %r" % e) + else: + print("mqtt: %r" % e) + + def reconnect(self): + i = 0 + while 1: + try: + return super().connect(False) + except OSError as e: + self.log(True, e) + i += 1 + self.delay(i) + + def publish(self, topic, msg, retain=False, qos=0): + while 1: + try: + return super().publish(topic, msg, retain, qos) + except OSError as e: + self.log(False, e) + self.reconnect() + + def wait_msg(self): + while 1: + try: + return super().wait_msg() + except OSError as e: + self.log(False, e) + self.reconnect() diff --git a/orbs/umqtt/simple.py b/orbs/umqtt/simple.py new file mode 100644 index 0000000..8216fa5 --- /dev/null +++ b/orbs/umqtt/simple.py @@ -0,0 +1,204 @@ +import usocket as socket +import ustruct as struct +from ubinascii import hexlify + +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 + self.pswd = password + 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) + #print(hex(len(msg)), hexlify(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 publish(self, topic, msg, retain=False, qos=0): + pkt = bytearray(b"\x30\0\0\0") + pkt[0] |= qos << 1 | retain + sz = 2 + len(topic) + len(msg) + if qos > 0: + sz += 2 + assert sz < 2097152 + i = 1 + while sz > 0x7f: + pkt[i] = (sz & 0x7f) | 0x80 + sz >>= 7 + i += 1 + pkt[i] = sz + #print(hex(len(pkt)), hexlify(pkt, ":")) + self.sock.write(pkt, i + 1) + self._send_str(topic) + if qos > 0: + self.pid += 1 + pid = self.pid + struct.pack_into("!H", pkt, 0, pid) + self.sock.write(pkt, 2) + self.sock.write(msg) + if qos == 1: + while 1: + op = self.wait_msg() + if op == 0x40: + sz = self.sock.read(1) + assert sz == b"\x02" + rcv_pid = self.sock.read(2) + rcv_pid = rcv_pid[0] << 8 | rcv_pid[1] + if pid == rcv_pid: + return + elif qos == 2: + assert 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) + #print(hex(len(pkt)), hexlify(pkt, ":")) + 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 + + # Wait for a single incoming MQTT message and process it. + # Subscribed messages are delivered to a callback previously + # set by .set_callback() method. Other (internal) MQTT + # messages processed internally. + 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()