GNU Linux-libre 4.19.264-gnu1
[releases.git] / arch / arm / mach-rockchip / sleep.S
1 /*
2  * Copyright (c) 2014, Fuzhou Rockchip Electronics Co., Ltd
3  * Author: Tony Xie <tony.xie@rock-chips.com>
4  *
5  * This program is free software; you can redistribute it and/or modify it
6  * under the terms and conditions of the GNU General Public License,
7  * version 2, as published by the Free Software Foundation.
8  *
9  * This program is distributed in the hope it will be useful, but WITHOUT
10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
12  * more details.
13  *
14  */
15
16 #include <linux/linkage.h>
17 #include <asm/assembler.h>
18 #include <asm/memory.h>
19
20 .data
21 /*
22  * this code will be copied from
23  * ddr to sram for system resumeing.
24  * so it is ".data section".
25  */
26         .align  2
27
28 ENTRY(rockchip_slp_cpu_resume)
29         setmode PSR_I_BIT | PSR_F_BIT | SVC_MODE, r1  @ set svc, irqs off
30         mrc     p15, 0, r1, c0, c0, 5
31         and     r1, r1, #0xf
32         cmp     r1, #0
33         /* olny cpu0 can continue to run, the others is halt here */
34         beq     cpu0run
35 secondary_loop:
36         wfe
37         b       secondary_loop
38 cpu0run:
39         ldr     r3, rkpm_bootdata_l2ctlr_f
40         cmp     r3, #0
41         beq     sp_set
42         ldr     r3, rkpm_bootdata_l2ctlr
43         mcr     p15, 1, r3, c9, c0, 2
44 sp_set:
45         ldr     sp, rkpm_bootdata_cpusp
46         ldr     r1, rkpm_bootdata_cpu_code
47         bx      r1
48 ENDPROC(rockchip_slp_cpu_resume)
49
50 /* Parameters filled in by the kernel */
51
52 /* Flag for whether to restore L2CTLR on resume */
53         .global rkpm_bootdata_l2ctlr_f
54 rkpm_bootdata_l2ctlr_f:
55         .long 0
56
57 /* Saved L2CTLR to restore on resume */
58         .global rkpm_bootdata_l2ctlr
59 rkpm_bootdata_l2ctlr:
60         .long 0
61
62 /* CPU resume SP addr */
63         .globl rkpm_bootdata_cpusp
64 rkpm_bootdata_cpusp:
65         .long 0
66
67 /* CPU resume function (physical address) */
68         .globl rkpm_bootdata_cpu_code
69 rkpm_bootdata_cpu_code:
70         .long 0
71
72 ENTRY(rk3288_bootram_sz)
73         .word   . - rockchip_slp_cpu_resume