import struct

xref = {}
period = 81  # number of bits set in dtrace_en array

def get_xref(fname):
	try:
		of = open(fname, "r").read()
	except:
		return
	for l in of.split("\n"):
		if l and l[0] == " ":
			n = int(l.split(":")[0])
			t = l.split(";")[1]
			xref[n] = t

def safe_xref(k):
	return xref[k] if k in xref else ""

def read_dfile(fd):
	a = fd.read().split()
	return [int(x) for x in a]

def show(a):
	b = [int(x) & 0xffffff for x in a]
	c = [x if x < 2**23 else x-2**24 for x in b]
	print "".join(["%3d  %8d  %9.6f  %s\n" % (ix, x, x*0.5**23, safe_xref(ix % period)) for ix, x in enumerate(c)])

def dcollect(prc, bufn=0, npt=81):
	rrr = prc.query_resp_list(["dtrace_status", ("dtrace_cmd", 2+bufn), "dtrace_status"])
	print(rrr)
	iter_count = 0
	while True:
		r = prc.query_resp_list(["dtrace_status"])[0]
		if r == 0:
			print("Unexpected 0 dtrace_status, aborting")
			return None
		if r == 4:
			break
		iter_count += 1
		if iter_count > 100:
			print("dcollect timed out waiting for dtrace_status == 4")
			return None
		time.sleep(0.003)
	b_base = 0x1c0000  # dtrace_data
	r = prc.reg_read_alist(range(b_base, b_base+npt))
	rrr = prc.query_resp_list(["dtrace_status", ("dtrace_cmd", bufn), "dtrace_status"])
	print(rrr)
	return [struct.unpack('!I', x[2])[0] for x in r]

def send_keep(prc, keep_en, bufn=1):
	# print keep_en
	keep_base = prc.get_write_address("shell_%d_dsp_piezo_trace_en" % bufn)
	alist = range(keep_base, keep_base+128)
	prc.mg.readwrite(alist=alist, dlist=keep_en, write=1)

def figure_keep(ss):
	'''
	Input of form 1-3,5,9-12
	Output will then set mask elements 1, 2, 3, 5, 9, 10, 11, 12
	Valid indices are 0 to 127
	'''
	print("figure_keep %s" % ss)
	m = 128 * [0]
	for term in ss.split(','):
		l1 = term.split('-')
		if len(l1) == 1:
			ixs = [int(l1[0])]
		elif len(l1) == 2:
			ixs = range(int(l1[0]), int(l1[1])+1)
		else:
			ixs = []
			print("unhandled %s" % term)
		for ix in ixs:
			m[ix] = 1
	return m

def usage():
	print("python dtracex.py -a $IP -n 82 -k 0-81")

if __name__ == '__main__':
	import sys
	import getopt
	get_xref("ops.vh")
	opts, args = getopt.getopt(sys.argv[1:], 'ha:p:f:b:n:k:', ['help', 'addr=', 'port=', 'file=', 'buf=', 'npt=', 'keep='])
	ip_addr = None
	port = 50006
	bufn = 1
	npt = 164
	fname = None
	keep_s = None
	for opt, arg in opts:
		if opt in ('-h', '--help'):
			usage()
			exit()
		elif opt in ('-a', '--address'):
			ip_addr = arg
		elif opt in ('-p', '--port'):
			port = int(arg)
		elif opt in ('-f', '--file'):
			fname = arg
		elif opt in ('-b', '--buf'):
			bufn = int(arg)
		elif opt in ('-n', '--npt'):
			npt = int(arg)
		elif opt in ('-k', '--keep'):
			keep_s = arg
	if keep_s:
		keep_en = figure_keep(keep_s)
		period = sum(keep_en)
	if ip_addr:
		from prc import c_prc
		import time
		prc = c_prc(ip_addr, port, use_spartan=False)
		if keep_s:
			send_keep(prc, keep_en, bufn=bufn)
		dtrace = dcollect(prc, bufn=bufn, npt=npt)
		if not dtrace:
			exit()
		if fname:
			b = [int(x) & 0xffffff for x in dtrace]
			c = [x if x < 2**23 else x-2**24 for x in b]
			of = open(fname, "w")
			of.write("".join(["%d\n" % x for x in c]))
		else:
			show(dtrace)
	elif fname:
		dtrace = read_dfile(open(fname, "r"))
		show(dtrace)
	else:
		show(sys.stdin)
