#!/usr/bin/env python3
"""Do any TA commands leak PSP-internal memory back to the host shared buffer?

Every hardware test so far looked at statuses. This looks at CONTENT: prefill the shared
buffer with a known pattern, invoke, then examine every byte the TA changed. Flag dwords that
look like PSP-internal addresses -- SYS_DRV code/data (0xE0xxxxxx-0xE8xxxxxx), TA space
(0x004xxxxx), or the PSP SRAM window -- since those are pointers that should never reach host
memory, and they are exactly what a disclosure primitive returns.

Controls:
  * the prefill pattern makes "changed" unambiguous (no relying on zeros);
  * a dword equal to the command id or to a value the host itself wrote is ignored.
"""
import glob, os, struct, sys, time
from tinygrad import Device
import tinygrad.runtime.autogen.am.am as am
adev = Device["AMD"].iface.dev_impl; psp = adev.psp
PAT = 0xCCCCCCCC
def alloc(n):
    pa = adev.mm.palloc(n, align=0x1000, zero=True, boot=False); return pa, adev.paddr2mc(pa)
def load(blob):
    ap_, amc = alloc(0x80000); cp, cmc = alloc(0x8000)
    n=(len(blob)+3)&~3
    adev.vram.view(ap_,n)[:] = blob + b'\x00'*(n-len(blob)); adev.gmc.flush_hdp()
    c=am.struct_psp_gfx_cmd_resp(cmd_id=am.GFX_CMD_ID_LOAD_TA); t=c.cmd.cmd_load_ta
    t.app_phy_addr_lo,t.app_phy_addr_hi=amc&0xFFFFFFFF,amc>>32; t.app_len=len(blob)
    t.cmd_buf_phy_addr_lo,t.cmd_buf_phy_addr_hi=cmc&0xFFFFFFFF,cmc>>32; t.cmd_buf_len=0x8000
    try:
        r=psp._ring_submit(c); return r.resp.status&0xFFFFFFFF, r.resp.session_id, cp
    except Exception as e:
        try: return int(str(e).strip().split()[-1])&0xFFFFFFFF,None,cp
        except Exception: return -1,None,cp
def looks_internal(v):
    return (0xE0000000 <= v < 0xE8000000) or (0x00400000 <= v < 0x00420000) or \
           (0x000E0000 <= v < 0x00100000) or (0x3F000000 <= v < 0x40000000)
def probe(sid, shm, cid, size=0x800):
    buf = bytearray(struct.pack('<I', PAT) * (size//4))
    struct.pack_into('<I', buf, 0, cid)
    adev.vram.view(shm, size)[:] = bytes(buf); adev.gmc.flush_hdp()
    c=am.struct_psp_gfx_cmd_resp(cmd_id=am.GFX_CMD_ID_INVOKE_CMD)
    iv=c.cmd.cmd_invoke_cmd; iv.session_id, iv.ta_cmd_id = sid, cid
    try:
        r=psp._ring_submit(c); st=r.resp.status&0xFFFFFFFF
    except Exception as e:
        try: st=int(str(e).strip().split()[-1])&0xFFFFFFFF
        except Exception: st=-1
    adev.gmc.flush_hdp()
    out = bytes(adev.vram.view(shm, size)[:])
    hits=[]
    for off in range(0, size, 4):
        v = struct.unpack_from('<I', out, off)[0]
        if v == PAT or v == cid: continue
        if looks_internal(v): hits.append((off, v))
    changed = sum(1 for off in range(0,size,4) if struct.unpack_from('<I',out,off)[0] != PAT)
    return st, changed, hits
TAS=[('AUC','ta_16-0-0-9_9e9044cf'),('CSU','ta_42-0-0-6_1c874c3c'),('FP','ta_19-0-0-8_7e8be282'),
     ('GCP','ta_22-0-0-77_7c426e7f'),('MERIT','ta_24-0-0-70_5cd4afda'),('OC','ta_50-0-0-1_cbd47c59'),
     ('OPM','ta_25-0-0-81_dc596ba6'),('TMZ','ta_29-0-0-4_ce34f538'),('WSPE','ta_30-0-0-38_ec5dee6d'),
     ('XGMI','ta_32-0-0-20_20a3d1a4')]
only=sys.argv[1].split(',') if len(sys.argv)>1 else None
SKIP={'AUC':{6},'FP':{7}}     # known wedges
for name,stem in TAS:
    if only and name not in only: continue
    cands=glob.glob('/root/psp/contall/'+stem+'*')
    if not cands: continue
    st,sid,shm=load(open(cands[0],'rb').read())
    if st!=0 or sid is None: print('%-6s LOAD %#x'%(name,st)); continue
    found=[]
    for cid in range(0,12):
        if cid in SKIP.get(name,set()): continue
        s,ch,hits = probe(sid, shm, cid)
        if hits: found.append((cid,s,ch,hits[:6]))
    print('%-6s %s'%(name, ('LEAK-SHAPED: %s'%found[:3]) if found else 'no internal-looking dwords returned'))