1 /* SPDX-License-Identifier: GPL-2.0 */
2 /*
3 * Sleep helper for Loongson-3 sleep mode.
4 *
5 * Author: Huacai Chen <chenhuacai@loongson.cn>
6 * Copyright (C) 2020-2022 Loongson Technology
7 */
8
9 #include <asm/asm.h>
10 #include <asm/asmmacro.h>
11 #include <asm/addrspace.h>
12 #include <asm/loongarch.h>
13 #include <asm/stackframe.h>
14
15 /* preparatory stuff */
16 .macro SETUP_SLEEP
17 addi.d sp, sp, -PT_SIZE
18 st.d $r1, sp, PT_R1
19 st.d $r2, sp, PT_R2
20 st.d $r3, sp, PT_R3
21 st.d $r4, sp, PT_R4
22 st.d $r21, sp, PT_R21
23 st.d $r22, sp, PT_R22
24 st.d $r23, sp, PT_R23
25 st.d $r24, sp, PT_R24
26 st.d $r25, sp, PT_R25
27 st.d $r26, sp, PT_R26
28 st.d $r27, sp, PT_R27
29 st.d $r28, sp, PT_R28
30 st.d $r29, sp, PT_R29
31 st.d $r30, sp, PT_R30
32 st.d $r31, sp, PT_R31
33
34 la.pcrel t0, acpi_saved_sp
35 st.d sp, t0, 0
36 .endm
37
38 .macro SETUP_WAKEUP
39 ld.d $r1, sp, PT_R1
40 ld.d $r2, sp, PT_R2
41 ld.d $r3, sp, PT_R3
42 ld.d $r4, sp, PT_R4
43 ld.d $r21, sp, PT_R21
44 ld.d $r22, sp, PT_R22
45 ld.d $r23, sp, PT_R23
46 ld.d $r24, sp, PT_R24
47 ld.d $r25, sp, PT_R25
48 ld.d $r26, sp, PT_R26
49 ld.d $r27, sp, PT_R27
50 ld.d $r28, sp, PT_R28
51 ld.d $r29, sp, PT_R29
52 ld.d $r30, sp, PT_R30
53 ld.d $r31, sp, PT_R31
54 .endm
55
56 .text
57 .align 12
58
59 /* Sleep/wakeup code for Loongson-3 */
60 SYM_FUNC_START(loongarch_suspend_enter)
61 SETUP_SLEEP
62 bl __flush_cache_all
63
64 /* Pass RA and SP to BIOS */
65 addi.d a1, sp, 0
66 la.pcrel a0, loongarch_wakeup_s
67 la.pcrel t0, loongarch_suspend_
68 ld.d t0, t0, 0
69 jirl ra, t0, 0 /* Call BIOS
70
71 /*
72 * This is where we return upon wakeup
73 * Reload all of the registers and ret
74 */
75 SYM_INNER_LABEL(loongarch_wakeup_start, SYM_L_
76 SETUP_DMWINS t0
77 JUMP_VIRT_ADDR t0, t1
78
79 /* Enable PG */
80 li.w t0, 0xb0
81 csrwr t0, LOONGARCH_CSR_CRMD
82
83 la.pcrel t0, acpi_saved_sp
84 ld.d sp, t0, 0
85 SETUP_WAKEUP
86 addi.d sp, sp, PT_SIZE
87 jr ra
88 SYM_FUNC_END(loongarch_suspend_enter)
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.