add utilities for led and gpio dump and detection

2026-08-30 14:52:51 +08:00 · 2026-06-21 13:04:04 -05:00
parent f122402bdd
commit ebc6cd06ad
4 changed files with 340 additions and 0 deletions
@@ -0,0 +1,95 @@
+#!/usr/bin/env python3
+
+#!/usr/bin/env python3
+
+import os
+import sys
+
+
+regs = list(range(65536))
+
+glb_mux = 0x65E0
+
+led3_0_set1  = 0x6528
+led1_0_set0  = 0x6548
+led_port_sel = 0x654c
+
+def get_word(i):
+	val = (regs[i+3] <<24) + (regs[i+2]<<16)  + (regs[i+1]<<8) + regs[i]
+#	print(f"READING {i:04x} : {val:08x}")
+	return val
+
+with open ('reg_dump.txt', 'r') as file:
+	for line in file:
+		(addr, data) = line.split(":")
+		data = [ int(x, 16) for x in data.strip().split(" ") ]
+		addr = int(addr, 16)
+		for x in range(len(data)):
+			regs[addr + x] = data[x]
+
+ledstr = []
+ledfmt = []
+print("LED pad Configuration:")
+for i in range(28):
+	j = i % 5
+	if j == 0:
+		idx = glb_mux + (i//5)*4
+		val = get_word(idx)
+	ledval = (val>>(6*j)) &0x3f
+	ledstr.append(f"{ledval:02x}")
+	ledfmt.append(f"{i:02x}")
+print(f"{' '.join(ledfmt)}")
+print(f"{' '.join(ledstr)}")
+print(f".led_mux = {{ 0x{', 0x'.join(ledstr)} }},")
+
+LED_TYPES = [
+	" 2G5",
+	" TWO_1G",
+	" 1G",
+	" 500M",
+	" 100M",
+	" 10M",
+	" LINK",
+	" LINK_FLASH",
+	" ACT",
+	" RX",
+	" TX",
+	" COL",
+	" DUPLEX",
+	" TRAINING",
+	" MASTER",
+	"",
+	" 10G",
+	" TWO_5G",
+	" 5G",
+	" TWO_2G5",
+]
+
+led_set = []
+led_set_str = []
+print("\nLED-set Configuration:")
+print("LED-ID         0               1               2               3")
+for i in range(4):
+	idval = []
+	idvalstr = []
+	for id in range(4):
+		val = 0xffff & ( get_word(led1_0_set0 - 8*i - ((id>>1)<<2)) >> (16*(id&1)) )
+		valhi = ( 0xf & ( get_word(led3_0_set1 - 4*(i>>1)) >> (16*(i&1) +  4*id)) ) << 16
+		val += valhi
+		idval.append(val)
+		valstr = "("
+		for bit in range(20):
+			if val & (1<<bit):
+				valstr += LED_TYPES[bit]
+		valstr += ")"
+		idvalstr.append(valstr)
+	led_set.append(idval)
+	led_set_str.append(idvalstr)
+	idstr = '           '.join([f"{d:05x}" for d in idval])
+	print(f"SET {i}:     {idstr}")
+	# print(f"{idvalstr}")
+
+portsel = get_word(led_port_sel)
+for i in range(3,9):
+	sel = (portsel>>(i<<1)) & 3
+	print(f"Port {i}: SET {sel}: {', '.join(led_set_str[sel])}")