m1n1/proxyclient/experiments/dcp_iboot_m2pro.py

#!/usr/bin/env python3
# SPDX-License-Identifier: MIT
import sys, pathlib
sys.path.append(str(pathlib.Path(__file__).resolve().parents[1]))

import struct
from construct import *

from m1n1.setup import *
from m1n1.shell import run_shell
from m1n1 import asm
from m1n1.hw.dart import DART
from m1n1.fw.dcp.iboot import DCPIBootClient, SurfaceFormat, EOTF, Transform, AddrFormat, Colorspace
from m1n1.proxyutils import RegMonitor

from m1n1.fw.smc import SMCClient, SMCError

smc_addr = u.adt["arm-io/smc"].get_reg(0)[0]
smc = SMCClient(u, smc_addr)
smc.start()
smc.start_ep(0x20)

smc.verbose = 0

smcep = smc.epmap[0x20]

def init_phy(stage, arg):
    print(f"init_phy({stage}, {arg})")
    phy_regs = [0x3_9c04_0000, 0x3_9c00_0000]
    if stage == 0x00:
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c000010 (lpdptx-phy0[1], offset 0x10) = 0x0
        p.read32(self.phy_regs[1] + 0x10)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c000010 (lpdptx-phy0[1], offset 0x10) = 0x0
        p.write32(self.phy_regs[1] + 0x10, 0x0)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.read32(self.phy_regs[1] + 0x48)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.write32(self.phy_regs[1] + 0x48, 0x333)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.read32(self.phy_regs[1] + 0x48)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.write32(self.phy_regs[1] + 0x48, 0x333)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.read32(self.phy_regs[1] + 0x48)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.write32(self.phy_regs[1] + 0x48, 0x333)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.read32(self.phy_regs[1] + 0x48)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.write32(self.phy_regs[1] + 0x48, 0x333)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.read32(self.phy_regs[1] + 0x48)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.write32(self.phy_regs[1] + 0x48, 0x333)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.read32(self.phy_regs[1] + 0x48)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.write32(self.phy_regs[1] + 0x48, 0x333)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.read32(self.phy_regs[1] + 0x48)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.write32(self.phy_regs[1] + 0x48, 0x333)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.read32(self.phy_regs[1] + 0x48)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.write32(self.phy_regs[1] + 0x48, 0x333)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.read32(self.phy_regs[1] + 0x48)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c000048 (lpdptx-phy0[1], offset 0x48) = 0x333
        p.write32(self.phy_regs[1] + 0x48, 0x333)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c042014 (lpdptx-phy0[0], offset 0x2014) = 0x300a0c
        p.read32(self.phy_regs[0] + 0x2014)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c042014 (lpdptx-phy0[0], offset 0x2014) = 0x300a0c
        p.write32(self.phy_regs[0] + 0x2014, 0x300a0c)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c0420b8 (lpdptx-phy0[0], offset 0x20b8) = 0x654800
        p.read32(self.phy_regs[0] + 0x20b8)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c0420b8 (lpdptx-phy0[0], offset 0x20b8) = 0x654800
        p.write32(self.phy_regs[0] + 0x20b8, 0x654800)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c042220 (lpdptx-phy0[0], offset 0x2220) = 0x11090a0
        p.read32(self.phy_regs[0] + 0x2220)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c042220 (lpdptx-phy0[0], offset 0x2220) = 0x11090a0
        p.write32(self.phy_regs[0] + 0x2220, 0x11090a0)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c04222c (lpdptx-phy0[0], offset 0x222c) = 0x103903
        p.read32(self.phy_regs[0] + 0x222c)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c04222c (lpdptx-phy0[0], offset 0x222c) = 0x103903
        p.write32(self.phy_regs[0] + 0x222c, 0x103903)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c04222c (lpdptx-phy0[0], offset 0x222c) = 0x103903
        p.read32(self.phy_regs[0] + 0x222c)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c04222c (lpdptx-phy0[0], offset 0x222c) = 0x103903
        p.write32(self.phy_regs[0] + 0x222c, 0x103903)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c042230 (lpdptx-phy0[0], offset 0x2230) = 0x2208804
        p.read32(self.phy_regs[0] + 0x2230)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c042230 (lpdptx-phy0[0], offset 0x2230) = 0x2208804
        p.write32(self.phy_regs[0] + 0x2230, 0x2208804)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c042278 (lpdptx-phy0[0], offset 0x2278) = 0x10300811
        p.read32(self.phy_regs[0] + 0x2278)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c042278 (lpdptx-phy0[0], offset 0x2278) = 0x10300811
        p.write32(self.phy_regs[0] + 0x2278, 0x10300811)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c0422a4 (lpdptx-phy0[0], offset 0x22a4) = 0x1044201
        p.read32(self.phy_regs[0] + 0x22a4)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c0422a4 (lpdptx-phy0[0], offset 0x22a4) = 0x1044201
        p.write32(self.phy_regs[0] + 0x22a4, 0x1044201)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c044008 (lpdptx-phy0[0], offset 0x4008) = 0x30010
        p.read32(self.phy_regs[0] + 0x4008)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c044008 (lpdptx-phy0[0], offset 0x4008) = 0x30010
        p.write32(self.phy_regs[0] + 0x4008, 0x30010)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c044008 (lpdptx-phy0[0], offset 0x4008) = 0x30010
        p.read32(self.phy_regs[0] + 0x4008)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c044008 (lpdptx-phy0[0], offset 0x4008) = 0x30010
        p.write32(self.phy_regs[0] + 0x4008, 0x30010)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c04420c (lpdptx-phy0[0], offset 0x420c) = 0x38c3
        p.read32(self.phy_regs[0] + 0x420c)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c04420c (lpdptx-phy0[0], offset 0x420c) = 0x38c3
        p.write32(self.phy_regs[0] + 0x420c, 0x38c3)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c044600 (lpdptx-phy0[0], offset 0x4600) = 0x8000041
        p.read32(self.phy_regs[0] + 0x4600)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c044600 (lpdptx-phy0[0], offset 0x4600) = 0x8000041
        p.write32(self.phy_regs[0] + 0x4600, 0x8000041)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c045040 (lpdptx-phy0[0], offset 0x5040) = 0xa1780
        p.read32(self.phy_regs[0] + 0x5040)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c045040 (lpdptx-phy0[0], offset 0x5040) = 0x2a1780
        p.write32(self.phy_regs[0] + 0x5040, 0x2a1780)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c046040 (lpdptx-phy0[0], offset 0x6040) = 0xa1780
        p.read32(self.phy_regs[0] + 0x6040)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c046040 (lpdptx-phy0[0], offset 0x6040) = 0x2a1780
        p.write32(self.phy_regs[0] + 0x6040, 0x2a1780)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c047040 (lpdptx-phy0[0], offset 0x7040) = 0xa1780
        p.read32(self.phy_regs[0] + 0x7040)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c047040 (lpdptx-phy0[0], offset 0x7040) = 0x2a1780
        p.write32(self.phy_regs[0] + 0x7040, 0x2a1780)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c048040 (lpdptx-phy0[0], offset 0x8040) = 0xa1780
        p.read32(self.phy_regs[0] + 0x8040)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c048040 (lpdptx-phy0[0], offset 0x8040) = 0x2a1780
        p.write32(self.phy_regs[0] + 0x8040, 0x2a1780)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c045040 (lpdptx-phy0[0], offset 0x5040) = 0x2a1780
        p.read32(self.phy_regs[0] + 0x5040)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c045040 (lpdptx-phy0[0], offset 0x5040) = 0x2a1780
        p.write32(self.phy_regs[0] + 0x5040, 0x2a1780)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c046040 (lpdptx-phy0[0], offset 0x6040) = 0x2a1780
        p.read32(self.phy_regs[0] + 0x6040)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c046040 (lpdptx-phy0[0], offset 0x6040) = 0x2a1780
        p.write32(self.phy_regs[0] + 0x6040, 0x2a1780)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c047040 (lpdptx-phy0[0], offset 0x7040) = 0x2a1780
        p.read32(self.phy_regs[0] + 0x7040)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c047040 (lpdptx-phy0[0], offset 0x7040) = 0x2a1780
        p.write32(self.phy_regs[0] + 0x7040, 0x2a1780)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c048040 (lpdptx-phy0[0], offset 0x8040) = 0x2a1780
        p.read32(self.phy_regs[0] + 0x8040)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c048040 (lpdptx-phy0[0], offset 0x8040) = 0x2a1780
        p.write32(self.phy_regs[0] + 0x8040, 0x2a1780)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c045244 (lpdptx-phy0[0], offset 0x5244) = 0x8
        p.read32(self.phy_regs[0] + 0x5244)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c045244 (lpdptx-phy0[0], offset 0x5244) = 0x8
        p.write32(self.phy_regs[0] + 0x5244, 0x8)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c046244 (lpdptx-phy0[0], offset 0x6244) = 0x8
        p.read32(self.phy_regs[0] + 0x6244)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c046244 (lpdptx-phy0[0], offset 0x6244) = 0x8
        p.write32(self.phy_regs[0] + 0x6244, 0x8)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c047244 (lpdptx-phy0[0], offset 0x7244) = 0x8
        p.read32(self.phy_regs[0] + 0x7244)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c047244 (lpdptx-phy0[0], offset 0x7244) = 0x8
        p.write32(self.phy_regs[0] + 0x7244, 0x8)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c048244 (lpdptx-phy0[0], offset 0x8244) = 0x8
        p.read32(self.phy_regs[0] + 0x8244)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c048244 (lpdptx-phy0[0], offset 0x8244) = 0x8
        p.write32(self.phy_regs[0] + 0x8244, 0x8)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c042214 (lpdptx-phy0[0], offset 0x2214) = 0x1e1
        p.read32(self.phy_regs[0] + 0x2214)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c042214 (lpdptx-phy0[0], offset 0x2214) = 0x1e1
        p.write32(self.phy_regs[0] + 0x2214, 0x1e1)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c042224 (lpdptx-phy0[0], offset 0x2224) = 0x20086000
        p.read32(self.phy_regs[0] + 0x2224)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c042224 (lpdptx-phy0[0], offset 0x2224) = 0x20086000
        p.write32(self.phy_regs[0] + 0x2224, 0x20086000)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c042200 (lpdptx-phy0[0], offset 0x2200) = 0x2002
        p.read32(self.phy_regs[0] + 0x2200)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c042200 (lpdptx-phy0[0], offset 0x2200) = 0x2002
        p.write32(self.phy_regs[0] + 0x2200, 0x2002)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c041000 (lpdptx-phy0[0], offset 0x1000) = 0xe0000001
        p.read32(self.phy_regs[0] + 0x1000)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c041000 (lpdptx-phy0[0], offset 0x1000) = 0xe0000001
        p.write32(self.phy_regs[0] + 0x1000, 0xe0000001)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c044004 (lpdptx-phy0[0], offset 0x4004) = 0x49
        p.read32(self.phy_regs[0] + 0x4004)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c044004 (lpdptx-phy0[0], offset 0x4004) = 0x49
        p.write32(self.phy_regs[0] + 0x4004, 0x49)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c044404 (lpdptx-phy0[0], offset 0x4404) = 0x555d444
        p.read32(self.phy_regs[0] + 0x4404)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c044404 (lpdptx-phy0[0], offset 0x4404) = 0x555d444
        p.write32(self.phy_regs[0] + 0x4404, 0x555d444)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c044404 (lpdptx-phy0[0], offset 0x4404) = 0x555d444
        p.read32(self.phy_regs[0] + 0x4404)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c044404 (lpdptx-phy0[0], offset 0x4404) = 0x555d444
        p.write32(self.phy_regs[0] + 0x4404, 0x555d444)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x41021ac
        p.read32(self.phy_regs[0] + 0x4000)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x41021ac
        p.write32(self.phy_regs[0] + 0x4000, 0x41021ac)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c045000 (lpdptx-phy0[0], offset 0x5000) = 0x100
        p.read32(self.phy_regs[0] + 0x5000)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c045000 (lpdptx-phy0[0], offset 0x5000) = 0x300
        p.write32(self.phy_regs[0] + 0x5000, 0x300)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c046000 (lpdptx-phy0[0], offset 0x6000) = 0x100
        p.read32(self.phy_regs[0] + 0x6000)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c046000 (lpdptx-phy0[0], offset 0x6000) = 0x300
        p.write32(self.phy_regs[0] + 0x6000, 0x300)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c047000 (lpdptx-phy0[0], offset 0x7000) = 0x100
        p.read32(self.phy_regs[0] + 0x7000)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c047000 (lpdptx-phy0[0], offset 0x7000) = 0x300
        p.write32(self.phy_regs[0] + 0x7000, 0x300)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c048000 (lpdptx-phy0[0], offset 0x8000) = 0x100
        p.read32(self.phy_regs[0] + 0x8000)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c048000 (lpdptx-phy0[0], offset 0x8000) = 0x300
        p.write32(self.phy_regs[0] + 0x8000, 0x300)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c045000 (lpdptx-phy0[0], offset 0x5000) = 0x300
        p.read32(self.phy_regs[0] + 0x5000)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c045000 (lpdptx-phy0[0], offset 0x5000) = 0x300
        p.write32(self.phy_regs[0] + 0x5000, 0x300)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c046000 (lpdptx-phy0[0], offset 0x6000) = 0x300
        p.read32(self.phy_regs[0] + 0x6000)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c046000 (lpdptx-phy0[0], offset 0x6000) = 0x300
        p.write32(self.phy_regs[0] + 0x6000, 0x300)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c047000 (lpdptx-phy0[0], offset 0x7000) = 0x300
        p.read32(self.phy_regs[0] + 0x7000)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c047000 (lpdptx-phy0[0], offset 0x7000) = 0x300
        p.write32(self.phy_regs[0] + 0x7000, 0x300)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c048000 (lpdptx-phy0[0], offset 0x8000) = 0x300
        p.read32(self.phy_regs[0] + 0x8000)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c048000 (lpdptx-phy0[0], offset 0x8000) = 0x300
        p.write32(self.phy_regs[0] + 0x8000, 0x300)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c044200 (lpdptx-phy0[0], offset 0x4200) = 0x4002420
        p.read32(self.phy_regs[0] + 0x4200)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c044200 (lpdptx-phy0[0], offset 0x4200) = 0x4002420
        p.write32(self.phy_regs[0] + 0x4200, 0x4002420)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c044600 (lpdptx-phy0[0], offset 0x4600) = 0x8000041
        p.read32(self.phy_regs[0] + 0x4600)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c044600 (lpdptx-phy0[0], offset 0x4600) = 0x8000040
        p.write32(self.phy_regs[0] + 0x4600, 0x8000040)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c044600 (lpdptx-phy0[0], offset 0x4600) = 0x8000000
        p.read32(self.phy_regs[0] + 0x4600)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c044600 (lpdptx-phy0[0], offset 0x4600) = 0x8000001
        p.write32(self.phy_regs[0] + 0x4600, 0x8000001)
        # [cpu0] [0xfffffe0014c965b0] MMIO: R.4   0x39c044600 (lpdptx-phy0[0], offset 0x4600) = 0x8000001
        p.read32(self.phy_regs[0] + 0x4600)
        # [cpu0] [0xfffffe0014c9678c] MMIO: W.4   0x39c044600 (lpdptx-phy0[0], offset 0x4600) = 0x8000003
        p.write32(self.phy_regs[0] + 0x4600, 0x8000003)
        # [cpu2] [0xfffffe0014c965b0] MMIO: R.4   0x39c044600 (lpdptx-phy0[0], offset 0x4600) = 0x8000043
        p.read32(self.phy_regs[0] + 0x4600)
        # [cpu2] [0xfffffe0014c965b0] MMIO: R.4   0x39c044600 (lpdptx-phy0[0], offset 0x4600) = 0x8000043
        p.read32(self.phy_regs[0] + 0x4600)
        # [cpu2] [0xfffffe0014c9678c] MMIO: W.4   0x39c044600 (lpdptx-phy0[0], offset 0x4600) = 0x8000041
        p.write32(self.phy_regs[0] + 0x4600, 0x8000041)
        # [cpu2] [0xfffffe0014c965b0] MMIO: R.4   0x39c044408 (lpdptx-phy0[0], offset 0x4408) = 0x483
        p.read32(self.phy_regs[0] + 0x4408)
        # [cpu2] [0xfffffe0014c9678c] MMIO: W.4   0x39c044408 (lpdptx-phy0[0], offset 0x4408) = 0x483
        p.write32(self.phy_regs[0] + 0x4408, 0x483)
        # [cpu2] [0xfffffe0014c965b0] MMIO: R.4   0x39c044408 (lpdptx-phy0[0], offset 0x4408) = 0x483
        p.read32(self.phy_regs[0] + 0x4408)
        # [cpu2] [0xfffffe0014c9678c] MMIO: W.4   0x39c044408 (lpdptx-phy0[0], offset 0x4408) = 0x483
        p.write32(self.phy_regs[0] + 0x4408, 0x483)
    elif stage == 0x09:
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c044004 (lpdptx-phy0[0], offset 0x4004) = 0x49
        p.write32(self.phy_regs[0] + 0x4004, 0x49)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x41021ac
        p.read32(self.phy_regs[0] + 0x4000)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x41021ac
        p.write32(self.phy_regs[0] + 0x4000, 0x41021ac)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c044004 (lpdptx-phy0[0], offset 0x4004) = 0x49
        p.read32(self.phy_regs[0] + 0x4004)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c044004 (lpdptx-phy0[0], offset 0x4004) = 0x41
        p.write32(self.phy_regs[0] + 0x4004, 0x41)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x41021ac
        p.read32(self.phy_regs[0] + 0x4000)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x41021ac
        p.write32(self.phy_regs[0] + 0x4000, 0x41021ac)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x41021ac
        p.read32(self.phy_regs[0] + 0x4000)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x41021ac
        p.write32(self.phy_regs[0] + 0x4000, 0x41021ac)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c042200 (lpdptx-phy0[0], offset 0x2200) = 0x2002
        p.read32(self.phy_regs[0] + 0x2200)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c042200 (lpdptx-phy0[0], offset 0x2200) = 0x2002
        p.read32(self.phy_regs[0] + 0x2200)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c042200 (lpdptx-phy0[0], offset 0x2200) = 0x2000
        p.write32(self.phy_regs[0] + 0x2200, 0x2000)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c04100c (lpdptx-phy0[0], offset 0x100c) = 0xf000
        p.read32(self.phy_regs[0] + 0x100c)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c04100c (lpdptx-phy0[0], offset 0x100c) = 0xf000
        p.write32(self.phy_regs[0] + 0x100c, 0xf000)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c04100c (lpdptx-phy0[0], offset 0x100c) = 0xf000
        p.read32(self.phy_regs[0] + 0x100c)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c04100c (lpdptx-phy0[0], offset 0x100c) = 0xf008
        p.write32(self.phy_regs[0] + 0x100c, 0xf008)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c041014 (lpdptx-phy0[0], offset 0x1014) = 0x1
        p.read32(self.phy_regs[0] + 0x1014)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c04100c (lpdptx-phy0[0], offset 0x100c) = 0xf008
        p.read32(self.phy_regs[0] + 0x100c)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c04100c (lpdptx-phy0[0], offset 0x100c) = 0xf000
        p.write32(self.phy_regs[0] + 0x100c, 0xf000)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c041008 (lpdptx-phy0[0], offset 0x1008) = 0x1
        p.read32(self.phy_regs[0] + 0x1008)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c042220 (lpdptx-phy0[0], offset 0x2220) = 0x11090a0
        p.read32(self.phy_regs[0] + 0x2220)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c042220 (lpdptx-phy0[0], offset 0x2220) = 0x1109020
        p.write32(self.phy_regs[0] + 0x2220, 0x1109020)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0420b0 (lpdptx-phy0[0], offset 0x20b0) = 0x1e0e01c2
        p.read32(self.phy_regs[0] + 0x20b0)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0420b0 (lpdptx-phy0[0], offset 0x20b0) = 0x1e0e02a3
        p.write32(self.phy_regs[0] + 0x20b0, 0x1e0e02a3)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0420b4 (lpdptx-phy0[0], offset 0x20b4) = 0x7fffffe
        p.read32(self.phy_regs[0] + 0x20b4)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0420b4 (lpdptx-phy0[0], offset 0x20b4) = 0xbff7ffe
        p.write32(self.phy_regs[0] + 0x20b4, 0xbff7ffe)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0420b4 (lpdptx-phy0[0], offset 0x20b4) = 0xbff7ffe
        p.read32(self.phy_regs[0] + 0x20b4)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0420b4 (lpdptx-phy0[0], offset 0x20b4) = 0xbff7ffc
        p.write32(self.phy_regs[0] + 0x20b4, 0xbff7ffc)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0420b8 (lpdptx-phy0[0], offset 0x20b8) = 0x654800
        p.read32(self.phy_regs[0] + 0x20b8)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0420b8 (lpdptx-phy0[0], offset 0x20b8) = 0x654800
        p.write32(self.phy_regs[0] + 0x20b8, 0x654800)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0420b8 (lpdptx-phy0[0], offset 0x20b8) = 0x654800
        p.read32(self.phy_regs[0] + 0x20b8)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0420b8 (lpdptx-phy0[0], offset 0x20b8) = 0x654800
        p.write32(self.phy_regs[0] + 0x20b8, 0x654800)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0420b8 (lpdptx-phy0[0], offset 0x20b8) = 0x654800
        p.read32(self.phy_regs[0] + 0x20b8)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0420b8 (lpdptx-phy0[0], offset 0x20b8) = 0x664800
        p.write32(self.phy_regs[0] + 0x20b8, 0x664800)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0420b8 (lpdptx-phy0[0], offset 0x20b8) = 0x664800
        p.read32(self.phy_regs[0] + 0x20b8)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0420b8 (lpdptx-phy0[0], offset 0x20b8) = 0x464800
        p.write32(self.phy_regs[0] + 0x20b8, 0x464800)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0420b8 (lpdptx-phy0[0], offset 0x20b8) = 0x464800
        p.read32(self.phy_regs[0] + 0x20b8)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0420b8 (lpdptx-phy0[0], offset 0x20b8) = 0x464800
        p.write32(self.phy_regs[0] + 0x20b8, 0x464800)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0x0
        p.read32(self.phy_regs[1] + 0xa0)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0x8
        p.write32(self.phy_regs[1] + 0xa0, 0x8)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0x8
        p.read32(self.phy_regs[1] + 0xa0)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0xc
        p.write32(self.phy_regs[1] + 0xa0, 0xc)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0xc
        p.read32(self.phy_regs[1] + 0xa0)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0x4000c
        p.write32(self.phy_regs[1] + 0xa0, 0x4000c)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0x4000c
        p.read32(self.phy_regs[1] + 0xa0)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0xc
        p.write32(self.phy_regs[1] + 0xa0, 0xc)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0xc
        p.read32(self.phy_regs[1] + 0xa0)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0x8000c
        p.write32(self.phy_regs[1] + 0xa0, 0x8000c)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0x8000c
        p.read32(self.phy_regs[1] + 0xa0)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0xc
        p.write32(self.phy_regs[1] + 0xa0, 0xc)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0xc
        p.read32(self.phy_regs[1] + 0xa0)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0x8
        p.write32(self.phy_regs[1] + 0xa0, 0x8)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0x8
        p.read32(self.phy_regs[1] + 0xa0)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c0000a0 (lpdptx-phy0[1], offset 0xa0) = 0x0
        p.write32(self.phy_regs[1] + 0xa0, 0x0)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c042000 (lpdptx-phy0[0], offset 0x2000) = 0x2
        p.read32(self.phy_regs[0] + 0x2000)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c042000 (lpdptx-phy0[0], offset 0x2000) = 0x2
        p.write32(self.phy_regs[0] + 0x2000, 0x2)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c042018 (lpdptx-phy0[0], offset 0x2018) = 0x0
        p.read32(self.phy_regs[0] + 0x2018)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c042018 (lpdptx-phy0[0], offset 0x2018) = 0x0
        p.write32(self.phy_regs[0] + 0x2018, 0x0)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c04100c (lpdptx-phy0[0], offset 0x100c) = 0xf000
        p.read32(self.phy_regs[0] + 0x100c)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c04100c (lpdptx-phy0[0], offset 0x100c) = 0xf007
        p.write32(self.phy_regs[0] + 0x100c, 0xf007)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c04100c (lpdptx-phy0[0], offset 0x100c) = 0xf007
        p.read32(self.phy_regs[0] + 0x100c)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c04100c (lpdptx-phy0[0], offset 0x100c) = 0xf00f
        p.write32(self.phy_regs[0] + 0x100c, 0xf00f)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c041014 (lpdptx-phy0[0], offset 0x1014) = 0x38f
        p.read32(self.phy_regs[0] + 0x1014)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c04100c (lpdptx-phy0[0], offset 0x100c) = 0xf00f
        p.read32(self.phy_regs[0] + 0x100c)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c04100c (lpdptx-phy0[0], offset 0x100c) = 0xf007
        p.write32(self.phy_regs[0] + 0x100c, 0xf007)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c041008 (lpdptx-phy0[0], offset 0x1008) = 0x9
        p.read32(self.phy_regs[0] + 0x1008)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c042200 (lpdptx-phy0[0], offset 0x2200) = 0x2000
        p.read32(self.phy_regs[0] + 0x2200)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c042200 (lpdptx-phy0[0], offset 0x2200) = 0x2002
        p.write32(self.phy_regs[0] + 0x2200, 0x2002)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c045010 (lpdptx-phy0[0], offset 0x5010) = 0x18003000
        p.read32(self.phy_regs[0] + 0x5010)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c045010 (lpdptx-phy0[0], offset 0x5010) = 0x18003000
        p.write32(self.phy_regs[0] + 0x5010, 0x18003000)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c046010 (lpdptx-phy0[0], offset 0x6010) = 0x18003000
        p.read32(self.phy_regs[0] + 0x6010)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c046010 (lpdptx-phy0[0], offset 0x6010) = 0x18003000
        p.write32(self.phy_regs[0] + 0x6010, 0x18003000)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c047010 (lpdptx-phy0[0], offset 0x7010) = 0x18003000
        p.read32(self.phy_regs[0] + 0x7010)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c047010 (lpdptx-phy0[0], offset 0x7010) = 0x18003000
        p.write32(self.phy_regs[0] + 0x7010, 0x18003000)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c048010 (lpdptx-phy0[0], offset 0x8010) = 0x18003000
        p.read32(self.phy_regs[0] + 0x8010)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c048010 (lpdptx-phy0[0], offset 0x8010) = 0x18003000
        p.write32(self.phy_regs[0] + 0x8010, 0x18003000)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x41021ac
        p.read32(self.phy_regs[0] + 0x4000)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x51021ac
        p.write32(self.phy_regs[0] + 0x4000, 0x51021ac)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x51021ac
        p.read32(self.phy_regs[0] + 0x4000)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x71021ac
        p.write32(self.phy_regs[0] + 0x4000, 0x71021ac)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c044004 (lpdptx-phy0[0], offset 0x4004) = 0x41
        p.read32(self.phy_regs[0] + 0x4004)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c044004 (lpdptx-phy0[0], offset 0x4004) = 0x49
        p.write32(self.phy_regs[0] + 0x4004, 0x49)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x71021ac
        p.read32(self.phy_regs[0] + 0x4000)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x71021ec
        p.write32(self.phy_regs[0] + 0x4000, 0x71021ec)
        # [cpu1] [0xfffffe0014c965b0] MMIO: R.4   0x39c044004 (lpdptx-phy0[0], offset 0x4004) = 0x49
        p.read32(self.phy_regs[0] + 0x4004)
        # [cpu1] [0xfffffe0014c9678c] MMIO: W.4   0x39c044004 (lpdptx-phy0[0], offset 0x4004) = 0x48
        p.write32(self.phy_regs[0] + 0x4004, 0x48)
    elif stage == 0x0c:
        if arg == 0:
            val1 = val2 = 0x300
        else:
            val1 = 0x100
            val2 = 0

        # [cpu0] [0xfffffe0014c365b0] MMIO: R.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x41021ac
        p.read32(self.phy_regs[0] + 0x4000)
        # [cpu0] [0xfffffe0014c3678c] MMIO: W.4   0x39c044000 (lpdptx-phy0[0], offset 0x4000) = 0x41021ac
        p.clear32(self.phy_regs[0] + 0x4000, 0x4000000)
        # [cpu0] [0xfffffe0014c365b0] MMIO: R.4   0x39c045000 (lpdptx-phy0[0], offset 0x5000) = 0x300
        p.read32(self.phy_regs[0] + 0x5000)
        # [cpu3] [DCPTracer@/arm-io/dcp0] [dcpep] >ACK CB.0 (0x42 (TYPE=0x2, LEN=0x0, OFF=0x0, CTX=0x0(CB), ACK=1))
        # [cpu0] [0xfffffe0014c3678c] MMIO: W.4   0x39c045000 (lpdptx-phy0[0], offset 0x5000) = 0x300
        p.write32(self.phy_regs[0] + 0x5000, val1)
        # [cpu0] [0xfffffe0014c365b0] MMIO: R.4   0x39c046000 (lpdptx-phy0[0], offset 0x6000) = 0x300
        p.read32(self.phy_regs[0] + 0x6000)
        # [cpu3] [DCPTracer@/arm-io/dcp0] [dcpep] 0x1c00000002 (TYPE=0x2, LEN=0x1c, OFF=0x0, CTX=0x0(CB), ACK=0)
        # [cpu3] [DCPTracer@/arm-io/dcp0] [dcpep] <CB.0 D300:void IOMFB::PropRelay::publish(IOMFB::RuntimeProperty, unsigned int) (0x1c00000002 (TYPE=0x2, LEN=0x1c, OFF=0x0, CTX=0x0(CB), ACK=0))
        # [cpu0] [0xfffffe0014c3678c] MMIO: W.4   0x39c046000 (lpdptx-phy0[0], offset 0x6000) = 0x300
        p.write32(self.phy_regs[0] + 0x6000, val1)
        # [cpu0] [0xfffffe0014c365b0] MMIO: R.4   0x39c047000 (lpdptx-phy0[0], offset 0x7000) = 0x300
        p.read32(self.phy_regs[0] + 0x7000)
        # [cpu0] [0xfffffe0014c3678c] MMIO: W.4   0x39c047000 (lpdptx-phy0[0], offset 0x7000) = 0x300
        p.write32(self.phy_regs[0] + 0x7000, val1)
        # [cpu0] [0xfffffe0014c365b0] MMIO: R.4   0x39c048000 (lpdptx-phy0[0], offset 0x8000) = 0x300
        p.read32(self.phy_regs[0] + 0x8000)
        # [cpu0] [0xfffffe0014c3678c] MMIO: W.4   0x39c048000 (lpdptx-phy0[0], offset 0x8000) = 0x300
        p.write32(self.phy_regs[0] + 0x8000, val1)
        # [cpu0] [0xfffffe0014c365b0] MMIO: R.4   0x39c045000 (lpdptx-phy0[0], offset 0x5000) = 0x300
        p.read32(self.phy_regs[0] + 0x5000)
        # [cpu0] [0xfffffe0014c3678c] MMIO: W.4   0x39c045000 (lpdptx-phy0[0], offset 0x5000) = 0x300
        p.write32(self.phy_regs[0] + 0x5000, val2)
        # [cpu0] [0xfffffe0014c365b0] MMIO: R.4   0x39c046000 (lpdptx-phy0[0], offset 0x6000) = 0x300
        p.read32(self.phy_regs[0] + 0x6000)
        # [cpu0] [0xfffffe0014c3678c] MMIO: W.4   0x39c046000 (lpdptx-phy0[0], offset 0x6000) = 0x300
        p.write32(self.phy_regs[0] + 0x6000, val2)
        # [cpu0] [0xfffffe0014c365b0] MMIO: R.4   0x39c047000 (lpdptx-phy0[0], offset 0x7000) = 0x300
        p.read32(self.phy_regs[0] + 0x7000)
        # [cpu0] [0xfffffe0014c3678c] MMIO: W.4   0x39c047000 (lpdptx-phy0[0], offset 0x7000) = 0x300
        p.write32(self.phy_regs[0] + 0x7000, val2)
        # [cpu0] [0xfffffe0014c365b0] MMIO: R.4   0x39c048000 (lpdptx-phy0[0], offset 0x8000) = 0x300
        p.read32(self.phy_regs[0] + 0x8000)
        # [cpu0] [0xfffffe0014c3678c] MMIO: W.4   0x39c048000 (lpdptx-phy0[0], offset 0x8000) = 0x300
        p.write32(self.phy_regs[0] + 0x8000, val2)

        if arg != 0:
            p.clear32(self.phy_regs[0] + 0x4000, 0x4000000)


print(f"Framebuffer at {u.ba.video.base:#x}")

p.display_shutdown(DCP_SHUTDOWN_MODE.QUIESCED)

dart = DART.from_adt(u, "arm-io/dart-dcp0")
disp_dart = DART.from_adt(u, "arm-io/dart-disp0")
#disp_dart.dump_all()

dart.dump_all()

dcp_addr = u.adt["arm-io/dcp0"].get_reg(0)[0]
dcp = DCPIBootClient(u, dcp_addr, dart, disp_dart)
dcp.dva_offset = getattr(u.adt["/arm-io/dcp0"][0], "asc_dram_mask", 0)
if not dcp.dva_offset:
    dcp.dva_offset = getattr(u.adt["/arm-io/dart-dcp0"], "vm-base", 0)
dcp.stream = u.adt["/arm-io/dart-dcp0/mapper-dcp0"].reg



print(f"DVA offset: {dcp.dva_offset:#x}")

dcp.start()
dcp.start_ep(0x20)
dcp.start_ep(0x22)
dcp.start_ep(0x23)
dcp.start_ep(0x24)
dcp.start_ep(0x2a)

dcp.system.wait_for("system")
dcp.system.system.setProperty("gAFKConfigLogMask", 0xffff)

dcp.dcpexpert.wait_for("dcpexpert")
dcp.iboot.wait_for("disp0")
dcp.dptx.wait_for("dcpav0")
dcp.dptx.wait_for("dcpdp0")
dcp.dpport.wait_for("port0")

smcep.write32("gP17", 0x800001)
smcep.write32("gP19", 0x800001)

dcp.dpport.port0.init_phy = init_phy
print("connect")
dcp.dpport.port0.connectTo(port=0x804, connected=0, unit=0)
print("request")
dcp.dpport.port0.displayRequest()

#dcp.dptx.dcpav0.forceHotPlugDetect()
#dcp.dptx.dcpav0.setVirtualDeviceMode(0)
#dcp.dptx.dcpav0.setPower(True)
#dcp.dptx.dcpav0.wakeDisplay()
#dcp.dptx.dcpav0.sleepDisplay()
#dcp.dptx.dcpav0.wakeDisplay()

print("Waiting for HPD...")
while True:
    hpd, ntim, ncolor = dcp.iboot.disp0.getModeCount()
    if hpd:
        break

print("HPD asserted")

print(f"Connected:{hpd} Timing modes:{ntim} Color modes:{ncolor}")
dcp.iboot.disp0.setPower(True)

timing_modes = dcp.iboot.disp0.getTimingModes()
print("Timing modes:")
print(timing_modes)

color_modes = dcp.iboot.disp0.getColorModes()
print("Color modes:")
print(color_modes)

timing_modes.sort(key=lambda c: (c.valid, c.width <= 1920, c.fps_int <= 60, c.width, c.height, c.fps_int, c.fps_frac))
timing_mode = timing_modes[-1]

color_modes.sort(key=lambda c: (c.valid, c.bpp <= 32, c.bpp, -int(c.colorimetry), -int(c.encoding), -int(c.eotf)))
color_mode = color_modes[-1]

print("Chosen timing mode:", timing_mode)
print("Chosen color mode:", color_mode)

dcp.iboot.disp0.setMode(timing_mode, color_mode)

w, h = timing_mode.width, timing_mode.height

fb_size = align_up(w * h * 4, 8 * 0x4000)
print(f"Display {w}x{h}, fb size: {fb_size}")

buf = u.memalign(0x4000, fb_size)

colors = [0xDD0000, 0xFE6230, 0xFEF600, 0x00BB00, 0x009BFE, 0x000083, 0x30009B]


for i, color in enumerate(colors):
    lines = h // len(colors)
    offset = i * lines * w * 4
    p.memset32(buf + offset, color, lines * w * 4)

iova = disp_dart.iomap(0, buf, fb_size)

layer = Container(
    planes = [
        Container(
            addr = iova,
            stride = u.ba.video.stride,
            addr_format = AddrFormat.PLANAR,
        ),
        Container(),
        Container()
    ],
    plane_cnt = 1,
    width = w,
    height = h,
    surface_fmt = SurfaceFormat.BGRA,
    colorspace = Colorspace.SRGB,
    eotf = EOTF.GAMMA_SDR,
    transform = Transform.NONE,
)

mw = min(w, u.ba.video.width)
mh = min(h, u.ba.video.height)

# swap = dcp.iboot.disp0.swapBegin()
# print(swap)
# dcp.iboot.disp0.swapSetLayer(0, layer, (mw, mh, 0, 0), (mw, mh, 0, 0))
# dcp.iboot.disp0.swapEnd()
#dcp.iboot.disp0.swapWait(swap.swap_id)

print("setSurface")
dcp.iboot.disp0.setSurface(layer)

run_shell(globals(), msg="Have fun!")

# full shutdown!
dcp.stop(1)
p.pmgr_reset(0, "DISP0_CPU0")