增加了生成包的工具,采用include包含发送包的初始化,尚未做严谨的测试
This commit is contained in:
@@ -1,49 +1,130 @@
|
||||
#!/usr/bin/env python
|
||||
#encoding=utf-8
|
||||
import random
|
||||
|
||||
from ctypes import *
|
||||
class GenPkt(object):
|
||||
def __init__(self):
|
||||
super(GenPkt, self).__init__()
|
||||
|
||||
self.pkt_buf = bytearray(b'\0' * 2048)
|
||||
self.pkt_type = 0
|
||||
self.pkt_sub_pkt = 0
|
||||
self.sub_pkt = list()
|
||||
|
||||
class TPkt(BigEndianStructure):
|
||||
pass
|
||||
TPkt._pack_ = 1
|
||||
TPkt._fields_=[
|
||||
('len', c_uint, 12),
|
||||
('rsv1', c_uint, 2),
|
||||
('type', c_uint, 2),
|
||||
('rsv2', c_uint16),
|
||||
('data', c_uint8 * 2040),
|
||||
]
|
||||
def clean(self):
|
||||
self.pkt_buf = bytearray(b'\0' * 2048)
|
||||
self.pkt_type = 0
|
||||
self.pkt_sub_pkt = 0
|
||||
self.sub_pkt = list()
|
||||
|
||||
class TSubPkt(BigEndianStructure):
|
||||
pass
|
||||
def setPktType(self, type):
|
||||
if (type != 0) and (type != 1):
|
||||
print('Error...set type failed:', type)
|
||||
else:
|
||||
self.pkt_type = type
|
||||
|
||||
TSubPkt._pack_ = 1
|
||||
TSubPkt._fields_=[
|
||||
('dev', c_uint, 14),
|
||||
('mode', c_uint, 2),
|
||||
('addr', c_uint16),
|
||||
('cmd', c_uint, 4),
|
||||
('slen', c_uint, 12),
|
||||
('wkr', c_uint16)
|
||||
]
|
||||
def addSubPkt(self, dev_idx, ptype, addr, cmd, len, data):
|
||||
if (len > 2032):
|
||||
print('Error, bad subpkt len:%d', len)
|
||||
return
|
||||
if not (ptype in [0, 2]):
|
||||
print('Error, bad subpkt type:', ptype)
|
||||
return
|
||||
if not (cmd in [0, 1, 2, 0xb, 0xc, 0xd, 0xe, 0xf]):
|
||||
print('Error, bad cmd:', cmd)
|
||||
return
|
||||
|
||||
self.pkt_sub_pkt = self.pkt_sub_pkt + 1
|
||||
self.sub_pkt.append([dev_idx, ptype, addr, cmd, len, data])
|
||||
|
||||
def gen(self, filename="pkt_verilog_test.v", filetype=0):
|
||||
pkt_len = 4
|
||||
for sp in self.sub_pkt:
|
||||
pkt_len = pkt_len + sp[4] + 8
|
||||
|
||||
if pkt_len > 2048:
|
||||
print('Error, bad pkt_len:', pkt_len)
|
||||
return
|
||||
|
||||
print("pkt_len:%d, data_len:%d"%(pkt_len, pkt_len - 4))
|
||||
|
||||
i = 4
|
||||
if self.pkt_type == 1:
|
||||
pkt_len = 0
|
||||
self.pkt_buf[0] = 0
|
||||
self.pkt_buf[1] = (self.pkt_type & 0x3)
|
||||
self.pkt_buf[2] = 0x3f
|
||||
self.pkt_buf[3] = 0xff
|
||||
else:
|
||||
#for i in range(pkt_len):
|
||||
self.pkt_buf[0] = ((pkt_len - 4) >> 4) & 0xff
|
||||
self.pkt_buf[1] = (((pkt_len - 4) << 4) & 0xf0) | (self.pkt_type & 0x3)
|
||||
self.pkt_buf[2] = 0
|
||||
self.pkt_buf[3] = 0
|
||||
|
||||
for sp in self.sub_pkt:
|
||||
#设备索引(14bit)+类型(2bit)
|
||||
temp = ((sp[0] & 0x3fff) << 2) | (sp[1] & 0x3)
|
||||
|
||||
self.pkt_buf[i] = (temp >> 8) & 0xff
|
||||
i = i + 1
|
||||
self.pkt_buf[i] = temp & 0xff
|
||||
i = i + 1
|
||||
|
||||
#地址
|
||||
self.pkt_buf[i] = (sp[2] >> 8) & 0xff
|
||||
i = i + 1
|
||||
self.pkt_buf[i] = sp[2] & 0xff
|
||||
i = i + 1
|
||||
|
||||
#命令类型(4bit)+长度(12bit)
|
||||
temp = (sp[3] << 12) | (sp[4] & 0xfff)
|
||||
|
||||
self.pkt_buf[i] = (temp >> 8) & 0xff
|
||||
i = i + 1
|
||||
self.pkt_buf[i] = temp & 0xff
|
||||
i = i + 1
|
||||
|
||||
#工作计数
|
||||
self.pkt_buf[i] = 0
|
||||
i = i + 1
|
||||
self.pkt_buf[i] = 0
|
||||
i = i + 1
|
||||
|
||||
#数据
|
||||
if sp[5] == None:
|
||||
for _k in range(sp[4]):
|
||||
self.pkt_buf[_k + i] = random.randint(0, 255)
|
||||
else:
|
||||
for _k in range(sp[4]):
|
||||
self.pkt_buf[_k + i] = sp[5][_k]
|
||||
|
||||
i = i + sp[4]
|
||||
|
||||
f = open(filename, "wt+")
|
||||
for _k in range(i):
|
||||
f.write("txBuf[%d]=8'h%02X;\n"%(3 + _k, self.pkt_buf[_k]))
|
||||
f.close()
|
||||
|
||||
if __name__ == '__main__':
|
||||
packet = b'\0' * 2048
|
||||
|
||||
pkt = cast (packet, POINTER(TPkt)).contents
|
||||
pkt.len = 512
|
||||
pkt.rsv1 = 0
|
||||
pkt.type = 0
|
||||
pkt.rsv2 = 0
|
||||
pkt.data[0] = 1
|
||||
pkt.data[1] = 2
|
||||
pkt.data[2] = 3
|
||||
pkt.data[3] = 4
|
||||
|
||||
for i in range(10):
|
||||
print(hex(packet[i]), ' ')
|
||||
genPkt = GenPkt()
|
||||
|
||||
genPkt.setPktType(1)
|
||||
genPkt.gen("./generated/shin/detect_pkt.vh")
|
||||
|
||||
genPkt.clean()
|
||||
|
||||
genPkt.setPktType(0)
|
||||
|
||||
#subPkt参数:索引、索引类型、地址、命令、长度、数据
|
||||
genPkt.addSubPkt(0x02, 0, 0x0830, 0x2, 56, None)
|
||||
genPkt.addSubPkt(0x01, 0, 0x0840, 0x1, 56, None)
|
||||
genPkt.addSubPkt(0x03, 0, 0x1040, 0x0, 56, None)
|
||||
for i in range(5):
|
||||
genPkt.addSubPkt(random.randint(100, 4000), 0, random.randint(0, 65536), 0x0, 56, None)
|
||||
#genPkt.addSubPkt(10, 2, 0x300, 0x2, 4, None)
|
||||
#genPkt.addSubPkt(11, 1, 0x300, 0x2, 4, None)
|
||||
genPkt.gen("./generated/shin/seq_pkt.vh")
|
||||
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user