Loading...
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/page.h>
13#include <asm/mipsregs.h>
14#include <asm/stackframe.h>
15#include <asm/addrspace.h>
16
17LEAF(relocate_new_kernel)
18 PTR_L s0, kexec_indirection_page
19 PTR_L s1, kexec_start_address
20
21process_entry:
22 PTR_L s2, (s0)
23 PTR_ADD s0, s0, SZREG
24
25 /* destination page */
26 and s3, s2, 0x1
27 beq s3, zero, 1f
28 and s4, s2, ~0x1 /* store destination addr in s4 */
29 move a0, s4
30 b process_entry
31
321:
33 /* indirection page, update s0 */
34 and s3, s2, 0x2
35 beq s3, zero, 1f
36 and s0, s2, ~0x2
37 b process_entry
38
391:
40 /* done page */
41 and s3, s2, 0x4
42 beq s3, zero, 1f
43 b done
441:
45 /* source page */
46 and s3, s2, 0x8
47 beq s3, zero, process_entry
48 and s2, s2, ~0x8
49 li s6, (1 << PAGE_SHIFT) / SZREG
50
51copy_word:
52 /* copy page word by word */
53 REG_L s5, (s2)
54 REG_S s5, (s4)
55 PTR_ADD s4, s4, SZREG
56 PTR_ADD s2, s2, SZREG
57 LONG_SUB s6, s6, 1
58 beq s6, zero, process_entry
59 b copy_word
60 b process_entry
61
62done:
63 /* jump to kexec_start_address */
64 j s1
65 END(relocate_new_kernel)
66
67kexec_start_address:
68 EXPORT(kexec_start_address)
69 PTR 0x0
70 .size kexec_start_address, PTRSIZE
71
72kexec_indirection_page:
73 EXPORT(kexec_indirection_page)
74 PTR 0
75 .size kexec_indirection_page, PTRSIZE
76
77relocate_new_kernel_end:
78
79relocate_new_kernel_size:
80 EXPORT(relocate_new_kernel_size)
81 PTR relocate_new_kernel_end - relocate_new_kernel
82 .size relocate_new_kernel_size, PTRSIZE
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 * Unfortunatelly, 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 uses 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