49 lines
945 B
ArmAsm
49 lines
945 B
ArmAsm
/*
|
|
* Copyright (c) 2019, ARM Limited and Contributors. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <arch.h>
|
|
#include <asm_macros.S>
|
|
#include <platform_def.h>
|
|
#include <cpus_on_fixed_addr.h>
|
|
|
|
.globl sys_sleep_flag_sram
|
|
.globl pmu_cpuson_entrypoint
|
|
|
|
.macro pmusram_entry_func _name
|
|
.section .pmusram.entry, "ax"
|
|
.type \_name, %function
|
|
.cfi_startproc
|
|
\_name:
|
|
.endm
|
|
|
|
pmusram_entry_func pmu_cpuson_entrypoint
|
|
adr x5, sys_sleep_flag_sram
|
|
ldr w2, [x5, #PSRAM_DT_PM_FLAG]
|
|
|
|
tbz w2, #PM_WARM_BOOT_SHT, sys_resume_sp
|
|
ldr x1, =platform_cpu_warmboot
|
|
br x1
|
|
sys_resume_sp:
|
|
adr x5, sys_sleep_flag_sram
|
|
ldr x1, [x5, #PSRAM_DT_SP]
|
|
mov sp, x1
|
|
ddr_resume:
|
|
ldr x1, [x5, #PSRAM_DT_DDR_FUNC]
|
|
cmp x1, #0
|
|
b.eq sys_resume
|
|
blr x1
|
|
sys_resume:
|
|
ldr x1, =bl31_warm_entrypoint
|
|
br x1
|
|
endfunc pmu_cpuson_entrypoint
|
|
|
|
.section .pmusram.data, "a"
|
|
.align 3
|
|
sys_sleep_flag_sram:
|
|
.rept PSRAM_DT_SIZE_WORDS
|
|
.word 0
|
|
.endr
|