Guest User

Untitled

a guest
Apr 13th, 2026
94
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Python 2.77 KB | None | 0 0
  1. #!/usr/bin/env python3
  2. # SPDX-License-Identifier: MIT
  3. import sys, pathlib, time
  4. sys.path.append(str(pathlib.Path(__file__).resolve().parents[1]))
  5.  
  6. from m1n1.setup import *
  7. from m1n1 import asm
  8. from m1n1.fw.smc import SMCClient
  9.  
  10. p.smp_start_secondaries()
  11. p.smp_stop_secondaries(True)
  12.  
  13.  
  14. code = u.malloc(0x1000)
  15.  
  16. util = asm.ARMAsm("""
  17. #define sys_reg(op0, op1, CRn, CRm, op2) s##op0##_##op1##_c##CRn##_c##CRm##_##op2
  18. #define ULONG(x)                         (x)
  19. #define BIT(x)                 (1UL << (x))
  20. #define GENMASK(msb, lsb)      ((BIT((msb + 1) - (lsb)) - 1) << (lsb))
  21. #define SYS_IMP_APL_ACC_OVRD sys_reg(3, 5, 15, 6, 0)
  22. #define ACC_OVRD_PWR_DN_SRM(x)                          ((ULONG(x)) << 13)
  23. #define ACC_OVRD_DIS_L2_FLUSH_ACC_SLEEP_MASK            GENMASK(16, 15)
  24. #define ACC_OVRD_DIS_L2_FLUSH_ACC_SLEEP(x)              ((ULONG(x)) << 15)
  25. #define ACC_OVRD_TRAIN_DOWN_LINK(x)                     ((ULONG(x)) << 17)
  26. #define ACC_OVRD_POWER_DOWN_CPM(x)                      ((ULONG(x)) << 25)
  27. #define ACC_OVRD_DISABLE_PIO_ON_WFI_CPU                 BIT(32)
  28. #define ACC_OVRD_DEEP_SLEEP                             BIT(34)
  29. #define SYS_IMP_APL_CYC_OVRD              sys_reg(3, 5, 15, 5, 0)
  30. #define CYC_OVRD_WFI_MODE(x)              ((ULONG(x)) << 24)
  31. #define CYC_OVRD_DISABLE_WFI_RET          BIT(0)
  32.  
  33.  
  34. sleep:
  35.    mrs x1, SYS_IMP_APL_ACC_OVRD
  36.    orr x1, x1, #ACC_OVRD_PWR_DN_SRM(3)
  37.    and x1, x1, #~ACC_OVRD_DIS_L2_FLUSH_ACC_SLEEP_MASK
  38.    orr x1, x1, #ACC_OVRD_DIS_L2_FLUSH_ACC_SLEEP(2)
  39.    orr x1, x1, #ACC_OVRD_TRAIN_DOWN_LINK(3)
  40.    orr x1, x1, #ACC_OVRD_POWER_DOWN_CPM(3)
  41.    orr x1, x1, #ACC_OVRD_DISABLE_PIO_ON_WFI_CPU
  42.    orr x1, x1, #ACC_OVRD_DEEP_SLEEP
  43.    msr SYS_IMP_APL_ACC_OVRD, x1
  44.  
  45.    mrs x1, SYS_IMP_APL_CYC_OVRD
  46.    orr x1, x1, #CYC_OVRD_WFI_MODE(3)
  47.    orr x1, x1, #CYC_OVRD_DISABLE_WFI_RET
  48.    msr SYS_IMP_APL_CYC_OVRD, x1
  49.  
  50. loop_wfi:
  51.    isb
  52.    wfi
  53.    ret
  54.  
  55.  
  56. go:
  57.    mov x1, #0x9b200000
  58.    movk x1, #0x3, lsl #32
  59.  
  60.    mov x0, '!'
  61.    str w0, [x1, 0x020]
  62.    mov x0, '!'
  63.    str w0, [x1, 0x020]
  64.    mov x0, '!'
  65.    str w0, [x1, 0x020]
  66.    mov x0, '!'
  67.    str w0, [x1, 0x020]
  68.  
  69.    ret
  70. """, code)
  71. iface.writemem(code, util.data)
  72. p.dc_cvau(code, len(util.data))
  73. p.ic_ivau(code, len(util.data))
  74.  
  75. p.write32(0x292004008, 0xf3ffafff)
  76. p.write32(0x29200400c, 0xffa1f6ff)
  77. p.write32(0x292004010, 0xfbdfffff)
  78. p.write32(0x292004014, 0x3fffffff)
  79. p.write32(0x292004018, 0xffffffc0)
  80. p.write32(0x29200401c, 0xffffffff)
  81. p.write32(0x292004020, 0x1fff)
  82.  
  83.  
  84. smc_addr = u.adt["arm-io/smc"].get_reg(0)[0]
  85. smc = SMCClient(u, smc_addr)
  86. smc.start()
  87. smc.start_ep(0x20)
  88. smcep = smc.epmap[0x20]
  89. smcep.write8("NTAP", 1)
  90. smc.work_for(1)
  91. smcep.write("MBSE", b'wpls')
  92. smc.work_for(1)
  93. smcep.write("MBSE", b'apls')
  94. smc.work_for(1)
  95.  
  96. p.call(util.sleep)
Advertisement
Add Comment
Please, Sign In to add comment