#!/usr/bin/env python3
"""After the 0x101D wedge: is sOS still alive (stalled handler) or dead (fault)?

A polite poll loop leaves sOS running and the ring merely unserviced; a fault/exception
should show in the PSP's own status registers. `is_sos_alive()` reads
regMP0_SMN_C2PMSG_81 != 0. Sample the relevant C2PMSG registers before and after the wedge.
"""
import glob, struct, sys, time
from tinygrad import Device
import tinygrad.runtime.autogen.am.am as am
adev = Device["AMD"].iface.dev_impl; psp = adev.psp
REGS = [33, 35, 64, 65, 66, 67, 81, 90, 91, 92]
def snap(tag):
    vals = {}
    for n in REGS:
        try: vals[n] = adev.reg(f"{psp.reg_pref}_{n}").read()
        except Exception as e: vals[n] = None
    print("%-8s sos_alive=%-5s %s" % (tag, psp.is_sos_alive(),
          ' '.join('%d=%#010x'%(n,v) for n,v in vals.items() if v is not None)))
    return vals
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 invoke(sid, shm, cid):
    buf=bytearray(0x2000); struct.pack_into('<I',buf,0,cid)
    adev.vram.view(shm,len(buf))[:]=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
    t0=time.time()
    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
    return st, time.time()-t0
snap('boot')
blob=open(glob.glob('/root/psp/contall/ta_16-0-0-9_9e9044cf*')[0],'rb').read()
st,sid,shm=load(blob); print('AUC load %#x sid=%s'%(st,sid))
snap('loaded')
s,dt=invoke(sid,shm,5); print('cmd5 -> %#x %.1fs'%(s,dt))
snap('after5')
s,dt=invoke(sid,shm,6); print('cmd6 -> %#x %.1fs  %s'%(s,dt,'WEDGE' if dt>5 else ''))
snap('after6')
time.sleep(3)
snap('+3s')