1/* SPDX-License-Identifier: GPL-2.0-only */
2/*
3 * linux/arch/unicore32/kernel/hibernate_asm.S
4 *
5 * Code specific to PKUnity SoC and UniCore ISA
6 *
7 *	Maintained by GUAN Xue-tao <gxt@mprc.pku.edu.cn>
8 *	Copyright (C) 2001-2010 Guan Xuetao
9 */
10
11#include <linux/sys.h>
12#include <linux/errno.h>
13#include <linux/linkage.h>
14#include <generated/asm-offsets.h>
15#include <asm/page.h>
16#include <asm/pgtable.h>
17#include <asm/assembler.h>
18
19@ restore_image(pgd_t *resume_pg_dir, struct pbe *restore_pblist)
20@ r0: resume_pg_dir
21@ r1: restore_pblist
22@ copy restore_pblist pages
23@ restore registers from swsusp_arch_regs_cpu0
24@
25ENTRY(restore_image)
26	sub	r0, r0, #PAGE_OFFSET
27	mov	r5, #0
28	movc	p0.c6, r5, #6	@invalidate ITLB & DTLB
29	movc	p0.c2, r0, #0
30	nop
31	nop
32	nop
33	nop
34	nop
35	nop
36	nop
37
38	.p2align 4,,7
39101:
40	csub.a	r1, #0
41	beq	109f
42
43	ldw	r6, [r1+], #PBE_ADDRESS
44	ldw	r7, [r1+], #PBE_ORIN_ADDRESS
45
46	movl	ip, #128
47102:	ldm.w	(r8 - r15), [r6]+
48	stm.w	(r8 - r15), [r7]+
49	sub.a	ip, ip, #1
50	bne	102b
51
52	ldw	r1, [r1+], #PBE_NEXT
53	b	101b
54
55	.p2align 4,,7
56109:
57	/* go back to the original page tables */
58	ldw	r0, =swapper_pg_dir
59	sub	r0, r0, #PAGE_OFFSET
60	mov	r5, #0
61	movc	p0.c6, r5, #6
62	movc	p0.c2, r0, #0
63	nop
64	nop
65	nop
66	nop
67	nop
68	nop
69	nop
70
71#ifdef	CONFIG_UNICORE_FPU_F64
72	ldw	ip, 1f
73	add	ip, ip, #SWSUSP_FPSTATE
74	lfm.w	(f0  - f7 ), [ip]+
75	lfm.w	(f8  - f15), [ip]+
76	lfm.w	(f16 - f23), [ip]+
77	lfm.w	(f24 - f31), [ip]+
78	ldw	r4, [ip]
79	ctf	r4, s31
80#endif
81	mov	r0, #0x0
82	ldw	ip, 1f
83	add	ip, ip, #SWSUSP_CPU
84	ldm.w	(r4 - r15), [ip]+
85	ldm	(r16 - r27, sp, pc), [ip]+	@ Load all regs saved previously
86
87	.align	2
881:	.long	swsusp_arch_regs_cpu0
89
90
91@ swsusp_arch_suspend()
92@ - prepare pc for resume, return from function without swsusp_save on resume
93@ - save registers in swsusp_arch_regs_cpu0
94@ - call swsusp_save write suspend image
95
96ENTRY(swsusp_arch_suspend)
97	ldw	ip, 1f
98	add	ip, ip, #SWSUSP_CPU
99	stm.w	(r4 - r15), [ip]+
100	stm.w	(r16 - r27, sp, lr), [ip]+
101
102#ifdef	CONFIG_UNICORE_FPU_F64
103	ldw	ip, 1f
104	add	ip, ip, #SWSUSP_FPSTATE
105	sfm.w	(f0  - f7 ), [ip]+
106	sfm.w	(f8  - f15), [ip]+
107	sfm.w	(f16 - f23), [ip]+
108	sfm.w	(f24 - f31), [ip]+
109	cff	r4, s31
110	stw	r4, [ip]
111#endif
112	b	swsusp_save			@ no return
113
1141:	.long	swsusp_arch_regs_cpu0
115