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))