1/*
2 * relocate_kernel.S for kexec
3 * Created by <nschichan@corp.free.fr> on Thu Oct 12 17:49:57 2006
4 *
5 * This source code is licensed under the GNU General Public License,
6 * Version 2.  See the file COPYING for more details.
7 */
8
9#include <asm/asm.h>
10#include <asm/asmmacro.h>
11#include <asm/regdef.h>
12#include <asm/mipsregs.h>
13#include <asm/stackframe.h>
14#include <asm/addrspace.h>
15
16LEAF(relocate_new_kernel)
17	PTR_L a0,	arg0
18	PTR_L a1,	arg1
19	PTR_L a2,	arg2
20	PTR_L a3,	arg3
21
22	PTR_L		s0, kexec_indirection_page
23	PTR_L		s1, kexec_start_address
24
25process_entry:
26	PTR_L		s2, (s0)
27	PTR_ADDIU	s0, s0, SZREG
28
29	/*
30	 * In case of a kdump/crash kernel, the indirection page is not
31	 * populated as the kernel is directly copied to a reserved location
32	 */
33	beqz		s2, done
34
35	/* destination page */
36	and		s3, s2, 0x1
37	beq		s3, zero, 1f
38	and		s4, s2, ~0x1	/* store destination addr in s4 */
39	b		process_entry
40
411:
42	/* indirection page, update s0	*/
43	and		s3, s2, 0x2
44	beq		s3, zero, 1f
45	and		s0, s2, ~0x2
46	b		process_entry
47
481:
49	/* done page */
50	and		s3, s2, 0x4
51	beq		s3, zero, 1f
52	b		done
531:
54	/* source page */
55	and		s3, s2, 0x8
56	beq		s3, zero, process_entry
57	and		s2, s2, ~0x8
58	li		s6, (1 << _PAGE_SHIFT) / SZREG
59
60copy_word:
61	/* copy page word by word */
62	REG_L		s5, (s2)
63	REG_S		s5, (s4)
64	PTR_ADDIU	s4, s4, SZREG
65	PTR_ADDIU	s2, s2, SZREG
66	LONG_ADDIU	s6, s6, -1
67	beq		s6, zero, process_entry
68	b		copy_word
69	b		process_entry
70
71done:
72#ifdef CONFIG_SMP
73	/* kexec_flag reset is signal to other CPUs what kernel
74	   was moved to it's location. Note - we need relocated address
75	   of kexec_flag.  */
76
77	bal		1f
78 1:	move		t1,ra;
79	PTR_LA		t2,1b
80	PTR_LA		t0,kexec_flag
81	PTR_SUB		t0,t0,t2;
82	PTR_ADD		t0,t1,t0;
83	LONG_S		zero,(t0)
84#endif
85
86#ifdef CONFIG_CPU_CAVIUM_OCTEON
87	/* We need to flush I-cache before jumping to new kernel.
88	 * Unfortunately, this code is cpu-specific.
89	 */
90	.set push
91	.set noreorder
92	syncw
93	syncw
94	synci		0($0)
95	.set pop
96#else
97	sync
98#endif
99	/* jump to kexec_start_address */
100	j		s1
101	END(relocate_new_kernel)
102
103#ifdef CONFIG_SMP
104/*
105 * Other CPUs should wait until code is relocated and
106 * then start at entry (?) point.
107 */
108LEAF(kexec_smp_wait)
109	PTR_L		a0, s_arg0
110	PTR_L		a1, s_arg1
111	PTR_L		a2, s_arg2
112	PTR_L		a3, s_arg3
113	PTR_L		s1, kexec_start_address
114
115	/* Non-relocated address works for args and kexec_start_address ( old
116	 * kernel is not overwritten). But we need relocated address of
117	 * kexec_flag.
118	 */
119
120	bal		1f
1211:	move		t1,ra;
122	PTR_LA		t2,1b
123	PTR_LA		t0,kexec_flag
124	PTR_SUB		t0,t0,t2;
125	PTR_ADD		t0,t1,t0;
126
1271:	LONG_L		s0, (t0)
128	bne		s0, zero,1b
129
130#ifdef CONFIG_CPU_CAVIUM_OCTEON
131	.set push
132	.set noreorder
133	synci		0($0)
134	.set pop
135#else
136	sync
137#endif
138	j		s1
139	END(kexec_smp_wait)
140#endif
141
142#ifdef __mips64
143       /* all PTR's must be aligned to 8 byte in 64-bit mode */
144       .align  3
145#endif
146
147/* All parameters to new kernel are passed in registers a0-a3.
148 * kexec_args[0..3] are used to prepare register values.
149 */
150
151kexec_args:
152	EXPORT(kexec_args)
153arg0:	PTR		0x0
154arg1:	PTR		0x0
155arg2:	PTR		0x0
156arg3:	PTR		0x0
157	.size	kexec_args,PTRSIZE*4
158
159#ifdef CONFIG_SMP
160/*
161 * Secondary CPUs may have different kernel parameters in
162 * their registers a0-a3. secondary_kexec_args[0..3] are used
163 * to prepare register values.
164 */
165secondary_kexec_args:
166	EXPORT(secondary_kexec_args)
167s_arg0: PTR		0x0
168s_arg1: PTR		0x0
169s_arg2: PTR		0x0
170s_arg3: PTR		0x0
171	.size	secondary_kexec_args,PTRSIZE*4
172kexec_flag:
173	LONG		0x1
174
175#endif
176
177kexec_start_address:
178	EXPORT(kexec_start_address)
179	PTR		0x0
180	.size		kexec_start_address, PTRSIZE
181
182kexec_indirection_page:
183	EXPORT(kexec_indirection_page)
184	PTR		0
185	.size		kexec_indirection_page, PTRSIZE
186
187relocate_new_kernel_end:
188
189relocate_new_kernel_size:
190	EXPORT(relocate_new_kernel_size)
191	PTR		relocate_new_kernel_end - relocate_new_kernel
192	.size		relocate_new_kernel_size, PTRSIZE
193