"""Deep hardware fuzzer for the HDCP TA, WITH display-core bring-up.

The naive version hit a closed gate (HDCP refuses most commands until DTM
TOPOLOGY_UPDATE_V2 has populated the ASD topology). This one replicates the
bring-up from exploit_hdcp_oob.py first, so the fuzz actually reaches handlers.

Layout (from the working exploit):
   buf[0x00] u32 = hdcp command id (mirrors ta_cmd_id)
   buf[0x0C] u32 = slot/handle
   buf[0x10] u32, buf[0x14] u32 = per-command params
   buf[0x28..] = payload bytes
   return code is read at out[4]
"""
import ctypes, struct, time, random, sys, collections
from tinygrad import Device
from tinygrad.runtime.autogen.am import am
from tinygrad.helpers import lo32, hi32

d=Device["AMD"]; adev=d.iface.dev_impl; psp=adev.psp
SZ=ctypes.sizeof(am.struct_psp_gfx_cmd_resp); P='/Users/user/dev/amd-psp-re/psp_out/'
def stat(): return int.from_bytes(bytes(adev.vram.view(psp.cmd_paddr,SZ)[:])[864:868],"little")
def alloc(n):
    pa=adev.mm.palloc(n,align=0x1000,zero=True); return pa,adev.paddr2mc(pa)
def load(cmd,blob):
    ap,amc=alloc(0x40000); cp,cmc=alloc(0x8000)
    adev.vram.view(ap,len(blob))[:]=blob; adev.gmc.flush_hdp()
    adev.vram.view(psp.cmd_paddr,SZ)[:]=b"\x00"*SZ
    c=am.struct_psp_gfx_cmd_resp(cmd_id=cmd); t=c.cmd.cmd_load_ta
    t.app_phy_addr_hi,t.app_phy_addr_lo=hi32(amc),lo32(amc); t.app_len=len(blob)
    t.cmd_buf_phy_addr_hi,t.cmd_buf_phy_addr_lo=hi32(cmc),lo32(cmc); t.cmd_buf_len=0x8000
    return psp._ring_submit(c).resp.session_id, cp
def inv(sid,shm,buf,tc):
    adev.vram.view(shm,0x8000)[:]=bytes(buf); adev.gmc.flush_hdp()
    adev.vram.view(psp.cmd_paddr,SZ)[:]=b"\x00"*SZ
    ic=am.struct_psp_gfx_cmd_resp(cmd_id=am.GFX_CMD_ID_INVOKE_CMD); iv=ic.cmd.cmd_invoke_cmd
    iv.session_id,iv.ta_cmd_id=sid,tc
    t0=time.time()
    try: psp._ring_submit(ic); ps=0
    except RuntimeError: ps=stat()
    except TimeoutError: return "TIMEOUT",None,time.time()-t0
    return ps, bytes(adev.vram.view(shm,0x2000)[:]), time.time()-t0

asd_sid,asd_shm = load(am.GFX_CMD_ID_LOAD_ASD, open(P+'asd_full.bin','rb').read())
dtm_sid,dtm_shm = load(am.GFX_CMD_ID_LOAD_TA,  open(P+'dtm_full.bin','rb').read())
hdcp_sid,hdcp_shm=load(am.GFX_CMD_ID_LOAD_TA,  open(P+'hdcp_full.bin','rb').read())
print("sids: asd=%#x dtm=%#x hdcp=%#x"%(asd_sid,dtm_sid,hdcp_sid))

def topo(h):
    b=bytearray(0x8000); struct.pack_into('<I',b,0,2)
    struct.pack_into('<10I',b,0x10,h,1,1,0,0,0,0,0,0,0)
    ps,out,_=inv(dtm_sid,dtm_shm,b,2)
    return struct.unpack_from('<I',out,8)[0] if out else None
print("display-core bring-up:", [topo(h) for h in range(8)])

def hdcp(cmd, mut=None):
    b=bytearray(0x8000); struct.pack_into('<I',b,0,cmd)
    if mut: mut(b)
    ps,out,dt=inv(hdcp_sid,hdcp_shm,b,cmd)
    if out is None: return "TIMEOUT",None,dt
    return ps, struct.unpack_from('<I',out,4)[0], dt
r,ret,_=hdcp(0x0E, lambda b: struct.pack_into('<I',b,0xC,0))
print("gate check cmd 0x0E -> ta_ret=%s (0 = OPEN)"%ret)

rng=random.Random(int(sys.argv[1]) if len(sys.argv)>1 else 1)
ROUNDS=int(sys.argv[2]) if len(sys.argv)>2 else 300
EXTREME=[0,1,2,3,0xffffffff,0x7fffffff,0x80000000,0xfffffffe,0xffff,0x10000,255,256,24,25,32,33,63,64,0x27b,0x27c]
seen=collections.defaultdict(collections.Counter); anoms=[]; t0=time.time()
for r_ in range(ROUNDS):
    cmd=rng.choice(list(range(1,16)))
    def mut(b):
        struct.pack_into('<I',b,0x0C,rng.choice([0,1,2,3,62,63,64,255,0xffffffff]))
        struct.pack_into('<I',b,0x10,rng.choice(EXTREME))
        struct.pack_into('<I',b,0x14,rng.choice(EXTREME))
        n=rng.choice([8,32,128,512,2048])
        for k in range(0x28,0x28+n): b[k]=rng.randrange(256)
        # sprinkle extreme dwords in the body
        for _ in range(6):
            off=rng.randrange(0x28,0x28+max(n-4,4))&~3
            struct.pack_into('<I',b,off,rng.choice(EXTREME))
    cap=bytearray(0x8000); struct.pack_into('<I',cap,0,cmd); mut(cap)
    ps,ret,dt=hdcp(cmd,lambda b: b.__setitem__(slice(0,0x8000),bytes(cap)))
    seen[cmd][ret]+=1
    if ps=="TIMEOUT" or dt>0.5:
        anoms.append((cmd,ps,dt))
        print("  ANOMALY round=%d cmd=%#x ps=%s dt=%.2f"%(r_,cmd,ps,dt))
        print("    hdr : %s"%bytes(cap[:0x30]).hex())
        print("    body: %s"%bytes(cap[0x28:0x78]).hex())
        open('hang_payload_cmd%02x.bin'%cmd,'wb').write(bytes(cap))
        print("    saved hang_payload_cmd%02x.bin ; sos_alive=%s"%(cmd,psp.is_sos_alive()))
        break
    if r_%100==0 and r_: print("  ...%d rounds %.0fs  sos_alive=%s"%(r_,time.time()-t0,psp.is_sos_alive()))
print("\n=== ta_ret histogram per hdcp cmd ===")
for c in sorted(seen): print("  cmd %#04x : %s"%(c,dict(seen[c])))
print("\nanomalies=%d  elapsed=%.0fs  sos_alive=%s"%(len(anoms),time.time()-t0,psp.is_sos_alive()))