1/* SPDX-License-Identifier: GPL-2.0-only */ 2/* 3 * Copyright (c) 2014, Fuzhou Rockchip Electronics Co., Ltd 4 * Author: Tony Xie <tony.xie@rock-chips.com> 5 */ 6 7#include <linux/linkage.h> 8#include <asm/assembler.h> 9#include <asm/page.h> 10 11.data 12/* 13 * this code will be copied from 14 * ddr to sram for system resumeing. 15 * so it is ".data section". 16 */ 17 .align 2 18 19ENTRY(rockchip_slp_cpu_resume) 20 setmode PSR_I_BIT | PSR_F_BIT | SVC_MODE, r1 @ set svc, irqs off 21 mrc p15, 0, r1, c0, c0, 5 22 and r1, r1, #0xf 23 cmp r1, #0 24 /* olny cpu0 can continue to run, the others is halt here */ 25 beq cpu0run 26secondary_loop: 27 wfe 28 b secondary_loop 29cpu0run: 30 ldr r3, rkpm_bootdata_l2ctlr_f 31 cmp r3, #0 32 beq sp_set 33 ldr r3, rkpm_bootdata_l2ctlr 34 mcr p15, 1, r3, c9, c0, 2 35sp_set: 36 ldr sp, rkpm_bootdata_cpusp 37 ldr r1, rkpm_bootdata_cpu_code 38 bx r1 39ENDPROC(rockchip_slp_cpu_resume) 40 41/* Parameters filled in by the kernel */ 42 43/* Flag for whether to restore L2CTLR on resume */ 44 .global rkpm_bootdata_l2ctlr_f 45rkpm_bootdata_l2ctlr_f: 46 .long 0 47 48/* Saved L2CTLR to restore on resume */ 49 .global rkpm_bootdata_l2ctlr 50rkpm_bootdata_l2ctlr: 51 .long 0 52 53/* CPU resume SP addr */ 54 .globl rkpm_bootdata_cpusp 55rkpm_bootdata_cpusp: 56 .long 0 57 58/* CPU resume function (physical address) */ 59 .globl rkpm_bootdata_cpu_code 60rkpm_bootdata_cpu_code: 61 .long 0 62 63ENTRY(rk3288_bootram_sz) 64 .word . - rockchip_slp_cpu_resume 65