增加高压空闲调节
This commit is contained in:
@@ -0,0 +1,88 @@
|
||||
# wget http://file.ofs.com/hv/script/umqtt/mqtt.py script/umqtt/mqtt.py
|
||||
# mqtt_client.py 测试
|
||||
|
||||
from script.umqtt.simple import MQTTClient
|
||||
from binascii import hexlify
|
||||
import machine
|
||||
import _thread
|
||||
import time, sys
|
||||
|
||||
|
||||
class MQTTClientThread:
|
||||
def __init__(self, server, client_id):
|
||||
self.server = server
|
||||
self.client_id = client_id
|
||||
self.running = False
|
||||
self.send_list = []
|
||||
self.receive_list = []
|
||||
self.lock = _thread.allocate_lock()
|
||||
self.client = MQTTClient(client_id, server)
|
||||
|
||||
def sub_cb(self, topic, msg):
|
||||
with self.lock:
|
||||
self.receive_list.append((topic, msg)) # 将接收到的消息添加到接收列表
|
||||
print("Received: {}".format((topic, msg)))
|
||||
|
||||
def run(self):
|
||||
try:
|
||||
self.client.set_callback(self.sub_cb)
|
||||
self.client.connect()
|
||||
print("Connected to {}".format(self.server))
|
||||
|
||||
for topic in self.sub_list:
|
||||
self.client.subscribe(topic)
|
||||
|
||||
self.running = True
|
||||
|
||||
while self.running:
|
||||
self.client.check_msg()
|
||||
self.process_messages()
|
||||
|
||||
print("mqtt exit")
|
||||
|
||||
except Exception as e:
|
||||
sys.print_exception(e)
|
||||
finally:
|
||||
_thread.exit()
|
||||
self.client.disconnect()
|
||||
print("mqtt stop")
|
||||
|
||||
def process_messages(self):
|
||||
with self.lock:
|
||||
while self.send_list:
|
||||
topic, msg, qos = self.send_list.pop(0) # 从发送列表中取出第一个消息
|
||||
self.client.publish(topic, msg, qos)
|
||||
# print("Sent: {} to topic: {} with QoS: {}".format(msg, topic, qos))
|
||||
|
||||
def start(self):
|
||||
if not self.running:
|
||||
_thread.stack_size(18192)
|
||||
_thread.start_new_thread(self.run, ())
|
||||
|
||||
def stop(self):
|
||||
self.running = False
|
||||
|
||||
def send_message(self, topic, message, qos=0):
|
||||
with self.lock:
|
||||
self.send_list.append((topic, message, qos)) # 将消息添加到发送列表
|
||||
# print("Queued for sending: {}".format((topic, message, qos)))
|
||||
|
||||
def take_message(self):
|
||||
with self.lock:
|
||||
if self.receive_list:
|
||||
return self.receive_list.pop(0) # 返回并移除接收列表的第一个消息
|
||||
else:
|
||||
return None # 如果没有消息,返回 None
|
||||
|
||||
|
||||
def start_mqtt_client(params={}):
|
||||
server = params['broker']['ip']
|
||||
client_id = params['broker']['clientid'] + hexlify(machine.unique_id()).decode()[0:8]
|
||||
mqtt_client = MQTTClientThread(server, client_id)
|
||||
mqtt_client.client.port = params['broker']['port']
|
||||
mqtt_client.client.user = params['broker']['user']
|
||||
mqtt_client.client.pswd = params['broker']['passwd']
|
||||
mqtt_client.sub_list = params['topic']['sub']
|
||||
mqtt_client.start()
|
||||
return mqtt_client
|
||||
|
||||
@@ -0,0 +1,220 @@
|
||||
import socket
|
||||
import struct
|
||||
from binascii import hexlify
|
||||
|
||||
|
||||
class MQTTException(Exception):
|
||||
pass
|
||||
|
||||
|
||||
class MQTTClient:
|
||||
def __init__(
|
||||
self,
|
||||
client_id,
|
||||
server,
|
||||
port=0,
|
||||
user=None,
|
||||
password=None,
|
||||
keepalive=0,
|
||||
ssl=None,
|
||||
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, timeout=None):
|
||||
self.sock = socket.socket()
|
||||
self.sock.settimeout(timeout)
|
||||
addr = socket.getaddrinfo(self.server, self.port)[0][-1]
|
||||
self.sock.connect(addr)
|
||||
if self.ssl is True:
|
||||
# Legacy support for ssl=True and ssl_params arguments.
|
||||
import ssl
|
||||
|
||||
self.sock = ssl.wrap_socket(self.sock, **self.ssl_params)
|
||||
elif self.ssl:
|
||||
self.sock = self.ssl.wrap_socket(self.sock, server_hostname=self.server)
|
||||
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:
|
||||
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:
|
||||
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
|
||||
return op
|
||||
|
||||
# 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()
|
||||
Reference in New Issue
Block a user