def wifi_hb_send():
global wifi_seq
rate_timer = threading.Timer(average_period, wifi_hb_send)
rate_timer.start()
data = struct.pack("<HIIbB3s6sBBH", int(bs_id, 16), 0x01, 0x09, -50, 0x03,
b'123', b'\1\2\3\4\5\6', 0x3, 0x1, wifi_seq)
wifi_seq += 1
frame = packet.get_packet(0x0A80, data, len(data))
com_instance.send(frame, len(frame))
mqtt.mqtt_pub(config.mqtt_topic_tx_header + bs_id, frame)
def uwb_cir_cfg(bs_id, cir_en, filter_len, filter_buff):
global mqtt
cfg_pload = struct.pack("<HHBB16s", 11, 0xffff, cir_en, filter_len,
filter_buff)
cfg_packet = packet.get_packet(0x2a11, cfg_pload, len(cfg_pload))
bs_rx_topic = config.mqtt_topic_rx_header
if bs_id == 0xffff:
bs_rx_topic += "brd"
else:
bs_rx_topic += "%04x" % (bs_id)
mqtt.mqtt_pub(bs_rx_topic, cfg_packet)
def calc_rate():
global old_time, show, calc_rate
#print("calc_rate")
rate_timer = threading.Timer(average_period, calc_rate)
rate_timer.start()
frame = packet.get_packet(0xab12, send_dat, len(send_dat))
mqtt.mqtt_pub("/NetTest/tx/test", frame)
t = time.time()
if old_time != 0:
show["figure_wifi_delay"]["show"]["send"]["data"].append(t - old_time)
old_time = t
def com_unregisterfun(cmd, data, port):
#print(hex(cmd),':',binascii.hexlify(data).upper())
frame = packet.get_packet(cmd, data, len(data))
mqtt.mqtt_pub(config.mqtt_topic_tx_header + bs_id, frame)
for rate_id in average_rate_dict.keys():
if((rate_id in show["figure_wifi_tx"]["show"].keys()) == False):
show["figure_wifi_tx"]["show"][rate_id] = dict()
show["figure_wifi_tx"]["show"][rate_id]["data"] = list()
show["figure_wifi_tx"]["show"][rate_id]["data"].append(average_rate_dict[rate_id])
average_rate_dict[rate_id] = 0
rate_timer = threading.Timer(average_period,calc_rate)
rate_timer.start()
'''
while(True):
time.sleep(0.01)
frame=packet.get_packet(0xab12,b'1234567890',len(b'1234567890'))
mqtt.mqtt_pub("/EH100602/tx/ab12",frame)
#print(hex(cmd),binascii.hexlify(data))
pass
mqtt_prase = prase.prase_class_init("mqtt_prase",mq,un_register)
def Prase_0A81_wifi_query_cfg_ack(data,l,port):
#print(data)
#print(type(data),len(data))
tp = struct.unpack("<H20s20s20s",data[:-3])
print("0x%04x %s %s %s"%(tp[0],tp[1].decode("utf-8"),tp[2].decode("utf-8"),tp[3].decode("utf-8")))
mqtt_prase.add_cmd(0x0A81,Prase_0A81_wifi_query_cfg_ack)
time.sleep(2)
query_data = b''
query_paket=packet.get_packet(0x0B81, query_data, len(query_data))
#print(binascii.hexlify(query_paket))
mqtt.mqtt_pub("/EH100602/rx/ff01",query_paket)
while(True):
#input_context = input("input :s(suspend figure),r(resume figure)")
#if(input_context == "s"):
#show_instance.suspend()
#mqtt.mqtt_pub("/EH100602/rx/ff01",query_paket)
time.sleep(5)
def un_register(cmd,data,port):
print(port,hex(cmd),binascii.hexlify(data))
pass
serial_prase = prase.prase_class_init("serial_prase",mqPacket,un_register)
#mqtt_prase.add_cmd(0x2A0A,Prase_2A0A_Test)
_uwb_msg = struct.pack('<BBBBHH',0x00,0x05,0x87,0x01,0xff01,0xfeff)
_uwb_msg_test = struct.pack('<BBBBHHH',0x00,0x05,0x50,0x01,interal,count,0xfeff)
time.sleep(1)
uwb_msg = packet.get_packet(0x0022,_uwb_msg,len(_uwb_msg))
serial_instance.send(uwb_msg,len(uwb_msg))
time.sleep(0.5)
uwb_msg_test = packet.get_packet(0x0022,_uwb_msg_test,len(_uwb_msg_test))
serial_instance.send(uwb_msg_test,len(uwb_msg_test))
time.sleep(1)
cnt = 0
while(True):
msg = mqSerial.get()
print("rcv %d:%s"%(cnt,msg))
cnt += 1
mqFileSave.put(msg)
mqPacket.put((msg,com))