Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #!/usr/bin/env python3
- # SPDX-License-Identifier: MIT
- import sys, pathlib, time
- sys.path.append(str(pathlib.Path(__file__).resolve().parents[1]))
- from m1n1.setup import *
- from m1n1 import asm
- from m1n1.fw.smc import SMCClient
- p.smp_start_secondaries()
- p.smp_stop_secondaries(True)
- code = u.malloc(0x1000)
- util = asm.ARMAsm("""
- #define sys_reg(op0, op1, CRn, CRm, op2) s##op0##_##op1##_c##CRn##_c##CRm##_##op2
- #define ULONG(x) (x)
- #define BIT(x) (1UL << (x))
- #define GENMASK(msb, lsb) ((BIT((msb + 1) - (lsb)) - 1) << (lsb))
- #define SYS_IMP_APL_ACC_OVRD sys_reg(3, 5, 15, 6, 0)
- #define ACC_OVRD_PWR_DN_SRM(x) ((ULONG(x)) << 13)
- #define ACC_OVRD_DIS_L2_FLUSH_ACC_SLEEP_MASK GENMASK(16, 15)
- #define ACC_OVRD_DIS_L2_FLUSH_ACC_SLEEP(x) ((ULONG(x)) << 15)
- #define ACC_OVRD_TRAIN_DOWN_LINK(x) ((ULONG(x)) << 17)
- #define ACC_OVRD_POWER_DOWN_CPM(x) ((ULONG(x)) << 25)
- #define ACC_OVRD_DISABLE_PIO_ON_WFI_CPU BIT(32)
- #define ACC_OVRD_DEEP_SLEEP BIT(34)
- #define SYS_IMP_APL_CYC_OVRD sys_reg(3, 5, 15, 5, 0)
- #define CYC_OVRD_WFI_MODE(x) ((ULONG(x)) << 24)
- #define CYC_OVRD_DISABLE_WFI_RET BIT(0)
- sleep:
- mrs x1, SYS_IMP_APL_ACC_OVRD
- orr x1, x1, #ACC_OVRD_PWR_DN_SRM(3)
- and x1, x1, #~ACC_OVRD_DIS_L2_FLUSH_ACC_SLEEP_MASK
- orr x1, x1, #ACC_OVRD_DIS_L2_FLUSH_ACC_SLEEP(2)
- orr x1, x1, #ACC_OVRD_TRAIN_DOWN_LINK(3)
- orr x1, x1, #ACC_OVRD_POWER_DOWN_CPM(3)
- orr x1, x1, #ACC_OVRD_DISABLE_PIO_ON_WFI_CPU
- orr x1, x1, #ACC_OVRD_DEEP_SLEEP
- msr SYS_IMP_APL_ACC_OVRD, x1
- mrs x1, SYS_IMP_APL_CYC_OVRD
- orr x1, x1, #CYC_OVRD_WFI_MODE(3)
- orr x1, x1, #CYC_OVRD_DISABLE_WFI_RET
- msr SYS_IMP_APL_CYC_OVRD, x1
- loop_wfi:
- isb
- wfi
- ret
- go:
- mov x1, #0x9b200000
- movk x1, #0x3, lsl #32
- mov x0, '!'
- str w0, [x1, 0x020]
- mov x0, '!'
- str w0, [x1, 0x020]
- mov x0, '!'
- str w0, [x1, 0x020]
- mov x0, '!'
- str w0, [x1, 0x020]
- ret
- """, code)
- iface.writemem(code, util.data)
- p.dc_cvau(code, len(util.data))
- p.ic_ivau(code, len(util.data))
- p.write32(0x292004008, 0xf3ffafff)
- p.write32(0x29200400c, 0xffa1f6ff)
- p.write32(0x292004010, 0xfbdfffff)
- p.write32(0x292004014, 0x3fffffff)
- p.write32(0x292004018, 0xffffffc0)
- p.write32(0x29200401c, 0xffffffff)
- p.write32(0x292004020, 0x1fff)
- smc_addr = u.adt["arm-io/smc"].get_reg(0)[0]
- smc = SMCClient(u, smc_addr)
- smc.start()
- smc.start_ep(0x20)
- smcep = smc.epmap[0x20]
- smcep.write8("NTAP", 1)
- smc.work_for(1)
- smcep.write("MBSE", b'wpls')
- smc.work_for(1)
- smcep.write("MBSE", b'apls')
- smc.work_for(1)
- p.call(util.sleep)
Advertisement
Add Comment
Please, Sign In to add comment