Loading...
1/*
2 * This file is subject to the terms and conditions of the GNU General Public
3 * License. See the file "COPYING" in the main directory of this archive
4 * for more details.
5 *
6 * Copyright (C) 1994, 1995, 1996, 1998, 1999, 2002, 2003 Ralf Baechle
7 * Copyright (C) 1996 David S. Miller (davem@davemloft.net)
8 * Copyright (C) 1994, 1995, 1996, by Andreas Busse
9 * Copyright (C) 1999 Silicon Graphics, Inc.
10 * Copyright (C) 2000 MIPS Technologies, Inc.
11 * written by Carsten Langgaard, carstenl@mips.com
12 */
13#include <asm/asm.h>
14#include <asm/cachectl.h>
15#include <asm/fpregdef.h>
16#include <asm/mipsregs.h>
17#include <asm/asm-offsets.h>
18#include <asm/page.h>
19#include <asm/pgtable-bits.h>
20#include <asm/regdef.h>
21#include <asm/stackframe.h>
22#include <asm/thread_info.h>
23
24#include <asm/asmmacro.h>
25
26/*
27 * Offset to the current process status flags, the first 32 bytes of the
28 * stack are not used.
29 */
30#define ST_OFF (_THREAD_SIZE - 32 - PT_SIZE + PT_STATUS)
31
32/*
33 * task_struct *resume(task_struct *prev, task_struct *next,
34 * struct thread_info *next_ti)
35 */
36 .align 7
37 LEAF(resume)
38 .set arch=octeon
39 mfc0 t1, CP0_STATUS
40 LONG_S t1, THREAD_STATUS(a0)
41 cpu_save_nonscratch a0
42 LONG_S ra, THREAD_REG31(a0)
43
44 /* check if we need to save COP2 registers */
45 PTR_L t2, TASK_THREAD_INFO(a0)
46 LONG_L t0, ST_OFF(t2)
47 bbit0 t0, 30, 1f
48
49 /* Disable COP2 in the stored process state */
50 li t1, ST0_CU2
51 xor t0, t1
52 LONG_S t0, ST_OFF(t2)
53
54 /* Enable COP2 so we can save it */
55 mfc0 t0, CP0_STATUS
56 or t0, t1
57 mtc0 t0, CP0_STATUS
58
59 /* Save COP2 */
60 daddu a0, THREAD_CP2
61 jal octeon_cop2_save
62 dsubu a0, THREAD_CP2
63
64 /* Disable COP2 now that we are done */
65 mfc0 t0, CP0_STATUS
66 li t1, ST0_CU2
67 xor t0, t1
68 mtc0 t0, CP0_STATUS
69
701:
71#if CONFIG_CAVIUM_OCTEON_CVMSEG_SIZE > 0
72 /* Check if we need to store CVMSEG state */
73 mfc0 t0, $11,7 /* CvmMemCtl */
74 bbit0 t0, 6, 3f /* Is user access enabled? */
75
76 /* Store the CVMSEG state */
77 /* Extract the size of CVMSEG */
78 andi t0, 0x3f
79 /* Multiply * (cache line size/sizeof(long)/2) */
80 sll t0, 7-LONGLOG-1
81 li t1, -32768 /* Base address of CVMSEG */
82 LONG_ADDI t2, a0, THREAD_CVMSEG /* Where to store CVMSEG to */
83 synciobdma
842:
85 .set noreorder
86 LONG_L t8, 0(t1) /* Load from CVMSEG */
87 subu t0, 1 /* Decrement loop var */
88 LONG_L t9, LONGSIZE(t1)/* Load from CVMSEG */
89 LONG_ADDU t1, LONGSIZE*2 /* Increment loc in CVMSEG */
90 LONG_S t8, 0(t2) /* Store CVMSEG to thread storage */
91 LONG_ADDU t2, LONGSIZE*2 /* Increment loc in thread storage */
92 bnez t0, 2b /* Loop until we've copied it all */
93 LONG_S t9, -LONGSIZE(t2)/* Store CVMSEG to thread storage */
94 .set reorder
95
96 /* Disable access to CVMSEG */
97 mfc0 t0, $11,7 /* CvmMemCtl */
98 xori t0, t0, 0x40 /* Bit 6 is CVMSEG user enable */
99 mtc0 t0, $11,7 /* CvmMemCtl */
100#endif
1013:
102 /*
103 * The order of restoring the registers takes care of the race
104 * updating $28, $29 and kernelsp without disabling ints.
105 */
106 move $28, a2
107 cpu_restore_nonscratch a1
108
109#if (_THREAD_SIZE - 32) < 0x8000
110 PTR_ADDIU t0, $28, _THREAD_SIZE - 32
111#else
112 PTR_LI t0, _THREAD_SIZE - 32
113 PTR_ADDU t0, $28
114#endif
115 set_saved_sp t0, t1, t2
116
117 mfc0 t1, CP0_STATUS /* Do we really need this? */
118 li a3, 0xff01
119 and t1, a3
120 LONG_L a2, THREAD_STATUS(a1)
121 nor a3, $0, a3
122 and a2, a3
123 or a2, t1
124 mtc0 a2, CP0_STATUS
125 move v0, a0
126 jr ra
127 END(resume)
128
129/*
130 * void octeon_cop2_save(struct octeon_cop2_state *a0)
131 */
132 .align 7
133 LEAF(octeon_cop2_save)
134
135 dmfc0 t9, $9,7 /* CvmCtl register. */
136
137 /* Save the COP2 CRC state */
138 dmfc2 t0, 0x0201
139 dmfc2 t1, 0x0202
140 dmfc2 t2, 0x0200
141 sd t0, OCTEON_CP2_CRC_IV(a0)
142 sd t1, OCTEON_CP2_CRC_LENGTH(a0)
143 sd t2, OCTEON_CP2_CRC_POLY(a0)
144 /* Skip next instructions if CvmCtl[NODFA_CP2] set */
145 bbit1 t9, 28, 1f
146
147 /* Save the LLM state */
148 dmfc2 t0, 0x0402
149 dmfc2 t1, 0x040A
150 sd t0, OCTEON_CP2_LLM_DAT(a0)
151 sd t1, OCTEON_CP2_LLM_DAT+8(a0)
152
1531: bbit1 t9, 26, 3f /* done if CvmCtl[NOCRYPTO] set */
154
155 /* Save the COP2 crypto state */
156 /* this part is mostly common to both pass 1 and later revisions */
157 dmfc2 t0, 0x0084
158 dmfc2 t1, 0x0080
159 dmfc2 t2, 0x0081
160 dmfc2 t3, 0x0082
161 sd t0, OCTEON_CP2_3DES_IV(a0)
162 dmfc2 t0, 0x0088
163 sd t1, OCTEON_CP2_3DES_KEY(a0)
164 dmfc2 t1, 0x0111 /* only necessary for pass 1 */
165 sd t2, OCTEON_CP2_3DES_KEY+8(a0)
166 dmfc2 t2, 0x0102
167 sd t3, OCTEON_CP2_3DES_KEY+16(a0)
168 dmfc2 t3, 0x0103
169 sd t0, OCTEON_CP2_3DES_RESULT(a0)
170 dmfc2 t0, 0x0104
171 sd t1, OCTEON_CP2_AES_INP0(a0) /* only necessary for pass 1 */
172 dmfc2 t1, 0x0105
173 sd t2, OCTEON_CP2_AES_IV(a0)
174 dmfc2 t2, 0x0106
175 sd t3, OCTEON_CP2_AES_IV+8(a0)
176 dmfc2 t3, 0x0107
177 sd t0, OCTEON_CP2_AES_KEY(a0)
178 dmfc2 t0, 0x0110
179 sd t1, OCTEON_CP2_AES_KEY+8(a0)
180 dmfc2 t1, 0x0100
181 sd t2, OCTEON_CP2_AES_KEY+16(a0)
182 dmfc2 t2, 0x0101
183 sd t3, OCTEON_CP2_AES_KEY+24(a0)
184 mfc0 t3, $15,0 /* Get the processor ID register */
185 sd t0, OCTEON_CP2_AES_KEYLEN(a0)
186 li t0, 0x000d0000 /* This is the processor ID of Octeon Pass1 */
187 sd t1, OCTEON_CP2_AES_RESULT(a0)
188 sd t2, OCTEON_CP2_AES_RESULT+8(a0)
189 /* Skip to the Pass1 version of the remainder of the COP2 state */
190 beq t3, t0, 2f
191
192 /* the non-pass1 state when !CvmCtl[NOCRYPTO] */
193 dmfc2 t1, 0x0240
194 dmfc2 t2, 0x0241
195 dmfc2 t3, 0x0242
196 dmfc2 t0, 0x0243
197 sd t1, OCTEON_CP2_HSH_DATW(a0)
198 dmfc2 t1, 0x0244
199 sd t2, OCTEON_CP2_HSH_DATW+8(a0)
200 dmfc2 t2, 0x0245
201 sd t3, OCTEON_CP2_HSH_DATW+16(a0)
202 dmfc2 t3, 0x0246
203 sd t0, OCTEON_CP2_HSH_DATW+24(a0)
204 dmfc2 t0, 0x0247
205 sd t1, OCTEON_CP2_HSH_DATW+32(a0)
206 dmfc2 t1, 0x0248
207 sd t2, OCTEON_CP2_HSH_DATW+40(a0)
208 dmfc2 t2, 0x0249
209 sd t3, OCTEON_CP2_HSH_DATW+48(a0)
210 dmfc2 t3, 0x024A
211 sd t0, OCTEON_CP2_HSH_DATW+56(a0)
212 dmfc2 t0, 0x024B
213 sd t1, OCTEON_CP2_HSH_DATW+64(a0)
214 dmfc2 t1, 0x024C
215 sd t2, OCTEON_CP2_HSH_DATW+72(a0)
216 dmfc2 t2, 0x024D
217 sd t3, OCTEON_CP2_HSH_DATW+80(a0)
218 dmfc2 t3, 0x024E
219 sd t0, OCTEON_CP2_HSH_DATW+88(a0)
220 dmfc2 t0, 0x0250
221 sd t1, OCTEON_CP2_HSH_DATW+96(a0)
222 dmfc2 t1, 0x0251
223 sd t2, OCTEON_CP2_HSH_DATW+104(a0)
224 dmfc2 t2, 0x0252
225 sd t3, OCTEON_CP2_HSH_DATW+112(a0)
226 dmfc2 t3, 0x0253
227 sd t0, OCTEON_CP2_HSH_IVW(a0)
228 dmfc2 t0, 0x0254
229 sd t1, OCTEON_CP2_HSH_IVW+8(a0)
230 dmfc2 t1, 0x0255
231 sd t2, OCTEON_CP2_HSH_IVW+16(a0)
232 dmfc2 t2, 0x0256
233 sd t3, OCTEON_CP2_HSH_IVW+24(a0)
234 dmfc2 t3, 0x0257
235 sd t0, OCTEON_CP2_HSH_IVW+32(a0)
236 dmfc2 t0, 0x0258
237 sd t1, OCTEON_CP2_HSH_IVW+40(a0)
238 dmfc2 t1, 0x0259
239 sd t2, OCTEON_CP2_HSH_IVW+48(a0)
240 dmfc2 t2, 0x025E
241 sd t3, OCTEON_CP2_HSH_IVW+56(a0)
242 dmfc2 t3, 0x025A
243 sd t0, OCTEON_CP2_GFM_MULT(a0)
244 dmfc2 t0, 0x025B
245 sd t1, OCTEON_CP2_GFM_MULT+8(a0)
246 sd t2, OCTEON_CP2_GFM_POLY(a0)
247 sd t3, OCTEON_CP2_GFM_RESULT(a0)
248 sd t0, OCTEON_CP2_GFM_RESULT+8(a0)
249 jr ra
250
2512: /* pass 1 special stuff when !CvmCtl[NOCRYPTO] */
252 dmfc2 t3, 0x0040
253 dmfc2 t0, 0x0041
254 dmfc2 t1, 0x0042
255 dmfc2 t2, 0x0043
256 sd t3, OCTEON_CP2_HSH_DATW(a0)
257 dmfc2 t3, 0x0044
258 sd t0, OCTEON_CP2_HSH_DATW+8(a0)
259 dmfc2 t0, 0x0045
260 sd t1, OCTEON_CP2_HSH_DATW+16(a0)
261 dmfc2 t1, 0x0046
262 sd t2, OCTEON_CP2_HSH_DATW+24(a0)
263 dmfc2 t2, 0x0048
264 sd t3, OCTEON_CP2_HSH_DATW+32(a0)
265 dmfc2 t3, 0x0049
266 sd t0, OCTEON_CP2_HSH_DATW+40(a0)
267 dmfc2 t0, 0x004A
268 sd t1, OCTEON_CP2_HSH_DATW+48(a0)
269 sd t2, OCTEON_CP2_HSH_IVW(a0)
270 sd t3, OCTEON_CP2_HSH_IVW+8(a0)
271 sd t0, OCTEON_CP2_HSH_IVW+16(a0)
272
2733: /* pass 1 or CvmCtl[NOCRYPTO] set */
274 jr ra
275 END(octeon_cop2_save)
276
277/*
278 * void octeon_cop2_restore(struct octeon_cop2_state *a0)
279 */
280 .align 7
281 .set push
282 .set noreorder
283 LEAF(octeon_cop2_restore)
284 /* First cache line was prefetched before the call */
285 pref 4, 128(a0)
286 dmfc0 t9, $9,7 /* CvmCtl register. */
287
288 pref 4, 256(a0)
289 ld t0, OCTEON_CP2_CRC_IV(a0)
290 pref 4, 384(a0)
291 ld t1, OCTEON_CP2_CRC_LENGTH(a0)
292 ld t2, OCTEON_CP2_CRC_POLY(a0)
293
294 /* Restore the COP2 CRC state */
295 dmtc2 t0, 0x0201
296 dmtc2 t1, 0x1202
297 bbit1 t9, 28, 2f /* Skip LLM if CvmCtl[NODFA_CP2] is set */
298 dmtc2 t2, 0x4200
299
300 /* Restore the LLM state */
301 ld t0, OCTEON_CP2_LLM_DAT(a0)
302 ld t1, OCTEON_CP2_LLM_DAT+8(a0)
303 dmtc2 t0, 0x0402
304 dmtc2 t1, 0x040A
305
3062:
307 bbit1 t9, 26, done_restore /* done if CvmCtl[NOCRYPTO] set */
308 nop
309
310 /* Restore the COP2 crypto state common to pass 1 and pass 2 */
311 ld t0, OCTEON_CP2_3DES_IV(a0)
312 ld t1, OCTEON_CP2_3DES_KEY(a0)
313 ld t2, OCTEON_CP2_3DES_KEY+8(a0)
314 dmtc2 t0, 0x0084
315 ld t0, OCTEON_CP2_3DES_KEY+16(a0)
316 dmtc2 t1, 0x0080
317 ld t1, OCTEON_CP2_3DES_RESULT(a0)
318 dmtc2 t2, 0x0081
319 ld t2, OCTEON_CP2_AES_INP0(a0) /* only really needed for pass 1 */
320 dmtc2 t0, 0x0082
321 ld t0, OCTEON_CP2_AES_IV(a0)
322 dmtc2 t1, 0x0098
323 ld t1, OCTEON_CP2_AES_IV+8(a0)
324 dmtc2 t2, 0x010A /* only really needed for pass 1 */
325 ld t2, OCTEON_CP2_AES_KEY(a0)
326 dmtc2 t0, 0x0102
327 ld t0, OCTEON_CP2_AES_KEY+8(a0)
328 dmtc2 t1, 0x0103
329 ld t1, OCTEON_CP2_AES_KEY+16(a0)
330 dmtc2 t2, 0x0104
331 ld t2, OCTEON_CP2_AES_KEY+24(a0)
332 dmtc2 t0, 0x0105
333 ld t0, OCTEON_CP2_AES_KEYLEN(a0)
334 dmtc2 t1, 0x0106
335 ld t1, OCTEON_CP2_AES_RESULT(a0)
336 dmtc2 t2, 0x0107
337 ld t2, OCTEON_CP2_AES_RESULT+8(a0)
338 mfc0 t3, $15,0 /* Get the processor ID register */
339 dmtc2 t0, 0x0110
340 li t0, 0x000d0000 /* This is the processor ID of Octeon Pass1 */
341 dmtc2 t1, 0x0100
342 bne t0, t3, 3f /* Skip the next stuff for non-pass1 */
343 dmtc2 t2, 0x0101
344
345 /* this code is specific for pass 1 */
346 ld t0, OCTEON_CP2_HSH_DATW(a0)
347 ld t1, OCTEON_CP2_HSH_DATW+8(a0)
348 ld t2, OCTEON_CP2_HSH_DATW+16(a0)
349 dmtc2 t0, 0x0040
350 ld t0, OCTEON_CP2_HSH_DATW+24(a0)
351 dmtc2 t1, 0x0041
352 ld t1, OCTEON_CP2_HSH_DATW+32(a0)
353 dmtc2 t2, 0x0042
354 ld t2, OCTEON_CP2_HSH_DATW+40(a0)
355 dmtc2 t0, 0x0043
356 ld t0, OCTEON_CP2_HSH_DATW+48(a0)
357 dmtc2 t1, 0x0044
358 ld t1, OCTEON_CP2_HSH_IVW(a0)
359 dmtc2 t2, 0x0045
360 ld t2, OCTEON_CP2_HSH_IVW+8(a0)
361 dmtc2 t0, 0x0046
362 ld t0, OCTEON_CP2_HSH_IVW+16(a0)
363 dmtc2 t1, 0x0048
364 dmtc2 t2, 0x0049
365 b done_restore /* unconditional branch */
366 dmtc2 t0, 0x004A
367
3683: /* this is post-pass1 code */
369 ld t2, OCTEON_CP2_HSH_DATW(a0)
370 ld t0, OCTEON_CP2_HSH_DATW+8(a0)
371 ld t1, OCTEON_CP2_HSH_DATW+16(a0)
372 dmtc2 t2, 0x0240
373 ld t2, OCTEON_CP2_HSH_DATW+24(a0)
374 dmtc2 t0, 0x0241
375 ld t0, OCTEON_CP2_HSH_DATW+32(a0)
376 dmtc2 t1, 0x0242
377 ld t1, OCTEON_CP2_HSH_DATW+40(a0)
378 dmtc2 t2, 0x0243
379 ld t2, OCTEON_CP2_HSH_DATW+48(a0)
380 dmtc2 t0, 0x0244
381 ld t0, OCTEON_CP2_HSH_DATW+56(a0)
382 dmtc2 t1, 0x0245
383 ld t1, OCTEON_CP2_HSH_DATW+64(a0)
384 dmtc2 t2, 0x0246
385 ld t2, OCTEON_CP2_HSH_DATW+72(a0)
386 dmtc2 t0, 0x0247
387 ld t0, OCTEON_CP2_HSH_DATW+80(a0)
388 dmtc2 t1, 0x0248
389 ld t1, OCTEON_CP2_HSH_DATW+88(a0)
390 dmtc2 t2, 0x0249
391 ld t2, OCTEON_CP2_HSH_DATW+96(a0)
392 dmtc2 t0, 0x024A
393 ld t0, OCTEON_CP2_HSH_DATW+104(a0)
394 dmtc2 t1, 0x024B
395 ld t1, OCTEON_CP2_HSH_DATW+112(a0)
396 dmtc2 t2, 0x024C
397 ld t2, OCTEON_CP2_HSH_IVW(a0)
398 dmtc2 t0, 0x024D
399 ld t0, OCTEON_CP2_HSH_IVW+8(a0)
400 dmtc2 t1, 0x024E
401 ld t1, OCTEON_CP2_HSH_IVW+16(a0)
402 dmtc2 t2, 0x0250
403 ld t2, OCTEON_CP2_HSH_IVW+24(a0)
404 dmtc2 t0, 0x0251
405 ld t0, OCTEON_CP2_HSH_IVW+32(a0)
406 dmtc2 t1, 0x0252
407 ld t1, OCTEON_CP2_HSH_IVW+40(a0)
408 dmtc2 t2, 0x0253
409 ld t2, OCTEON_CP2_HSH_IVW+48(a0)
410 dmtc2 t0, 0x0254
411 ld t0, OCTEON_CP2_HSH_IVW+56(a0)
412 dmtc2 t1, 0x0255
413 ld t1, OCTEON_CP2_GFM_MULT(a0)
414 dmtc2 t2, 0x0256
415 ld t2, OCTEON_CP2_GFM_MULT+8(a0)
416 dmtc2 t0, 0x0257
417 ld t0, OCTEON_CP2_GFM_POLY(a0)
418 dmtc2 t1, 0x0258
419 ld t1, OCTEON_CP2_GFM_RESULT(a0)
420 dmtc2 t2, 0x0259
421 ld t2, OCTEON_CP2_GFM_RESULT+8(a0)
422 dmtc2 t0, 0x025E
423 dmtc2 t1, 0x025A
424 dmtc2 t2, 0x025B
425
426done_restore:
427 jr ra
428 nop
429 END(octeon_cop2_restore)
430 .set pop
431
432/*
433 * void octeon_mult_save()
434 * sp is assumed to point to a struct pt_regs
435 *
436 * NOTE: This is called in SAVE_SOME in stackframe.h. It can only
437 * safely modify k0 and k1.
438 */
439 .align 7
440 .set push
441 .set noreorder
442 LEAF(octeon_mult_save)
443 dmfc0 k0, $9,7 /* CvmCtl register. */
444 bbit1 k0, 27, 1f /* Skip CvmCtl[NOMUL] */
445 nop
446
447 /* Save the multiplier state */
448 v3mulu k0, $0, $0
449 v3mulu k1, $0, $0
450 sd k0, PT_MTP(sp) /* PT_MTP has P0 */
451 v3mulu k0, $0, $0
452 sd k1, PT_MTP+8(sp) /* PT_MTP+8 has P1 */
453 ori k1, $0, 1
454 v3mulu k1, k1, $0
455 sd k0, PT_MTP+16(sp) /* PT_MTP+16 has P2 */
456 v3mulu k0, $0, $0
457 sd k1, PT_MPL(sp) /* PT_MPL has MPL0 */
458 v3mulu k1, $0, $0
459 sd k0, PT_MPL+8(sp) /* PT_MPL+8 has MPL1 */
460 jr ra
461 sd k1, PT_MPL+16(sp) /* PT_MPL+16 has MPL2 */
462
4631: /* Resume here if CvmCtl[NOMUL] */
464 jr ra
465 END(octeon_mult_save)
466 .set pop
467
468/*
469 * void octeon_mult_restore()
470 * sp is assumed to point to a struct pt_regs
471 *
472 * NOTE: This is called in RESTORE_SOME in stackframe.h.
473 */
474 .align 7
475 .set push
476 .set noreorder
477 LEAF(octeon_mult_restore)
478 dmfc0 k1, $9,7 /* CvmCtl register. */
479 ld v0, PT_MPL(sp) /* MPL0 */
480 ld v1, PT_MPL+8(sp) /* MPL1 */
481 ld k0, PT_MPL+16(sp) /* MPL2 */
482 bbit1 k1, 27, 1f /* Skip CvmCtl[NOMUL] */
483 /* Normally falls through, so no time wasted here */
484 nop
485
486 /* Restore the multiplier state */
487 ld k1, PT_MTP+16(sp) /* P2 */
488 MTM0 v0 /* MPL0 */
489 ld v0, PT_MTP+8(sp) /* P1 */
490 MTM1 v1 /* MPL1 */
491 ld v1, PT_MTP(sp) /* P0 */
492 MTM2 k0 /* MPL2 */
493 MTP2 k1 /* P2 */
494 MTP1 v0 /* P1 */
495 jr ra
496 MTP0 v1 /* P0 */
497
4981: /* Resume here if CvmCtl[NOMUL] */
499 jr ra
500 nop
501 END(octeon_mult_restore)
502 .set pop
1/*
2 * This file is subject to the terms and conditions of the GNU General Public
3 * License. See the file "COPYING" in the main directory of this archive
4 * for more details.
5 *
6 * Copyright (C) 1994, 1995, 1996, 1998, 1999, 2002, 2003 Ralf Baechle
7 * Copyright (C) 1996 David S. Miller (davem@davemloft.net)
8 * Copyright (C) 1994, 1995, 1996, by Andreas Busse
9 * Copyright (C) 1999 Silicon Graphics, Inc.
10 * Copyright (C) 2000 MIPS Technologies, Inc.
11 * written by Carsten Langgaard, carstenl@mips.com
12 */
13
14#define USE_ALTERNATE_RESUME_IMPL 1
15 .set push
16 .set arch=mips64r2
17#include "r4k_switch.S"
18 .set pop
19/*
20 * task_struct *resume(task_struct *prev, task_struct *next,
21 * struct thread_info *next_ti)
22 */
23 .align 7
24 LEAF(resume)
25 .set arch=octeon
26 mfc0 t1, CP0_STATUS
27 LONG_S t1, THREAD_STATUS(a0)
28 cpu_save_nonscratch a0
29 LONG_S ra, THREAD_REG31(a0)
30
31#if CONFIG_CAVIUM_OCTEON_CVMSEG_SIZE > 0
32 /* Check if we need to store CVMSEG state */
33 dmfc0 t0, $11,7 /* CvmMemCtl */
34 bbit0 t0, 6, 3f /* Is user access enabled? */
35
36 /* Store the CVMSEG state */
37 /* Extract the size of CVMSEG */
38 andi t0, 0x3f
39 /* Multiply * (cache line size/sizeof(long)/2) */
40 sll t0, 7-LONGLOG-1
41 li t1, -32768 /* Base address of CVMSEG */
42 LONG_ADDI t2, a0, THREAD_CVMSEG /* Where to store CVMSEG to */
43 synciobdma
442:
45 .set noreorder
46 LONG_L t8, 0(t1) /* Load from CVMSEG */
47 subu t0, 1 /* Decrement loop var */
48 LONG_L t9, LONGSIZE(t1)/* Load from CVMSEG */
49 LONG_ADDU t1, LONGSIZE*2 /* Increment loc in CVMSEG */
50 LONG_S t8, 0(t2) /* Store CVMSEG to thread storage */
51 LONG_ADDU t2, LONGSIZE*2 /* Increment loc in thread storage */
52 bnez t0, 2b /* Loop until we've copied it all */
53 LONG_S t9, -LONGSIZE(t2)/* Store CVMSEG to thread storage */
54 .set reorder
55
56 /* Disable access to CVMSEG */
57 dmfc0 t0, $11,7 /* CvmMemCtl */
58 xori t0, t0, 0x40 /* Bit 6 is CVMSEG user enable */
59 dmtc0 t0, $11,7 /* CvmMemCtl */
60#endif
613:
62
63#if defined(CONFIG_CC_STACKPROTECTOR) && !defined(CONFIG_SMP)
64 PTR_LA t8, __stack_chk_guard
65 LONG_L t9, TASK_STACK_CANARY(a1)
66 LONG_S t9, 0(t8)
67#endif
68
69 /*
70 * The order of restoring the registers takes care of the race
71 * updating $28, $29 and kernelsp without disabling ints.
72 */
73 move $28, a2
74 cpu_restore_nonscratch a1
75
76 PTR_ADDU t0, $28, _THREAD_SIZE - 32
77 set_saved_sp t0, t1, t2
78
79 mfc0 t1, CP0_STATUS /* Do we really need this? */
80 li a3, 0xff01
81 and t1, a3
82 LONG_L a2, THREAD_STATUS(a1)
83 nor a3, $0, a3
84 and a2, a3
85 or a2, t1
86 mtc0 a2, CP0_STATUS
87 move v0, a0
88 jr ra
89 END(resume)
90
91/*
92 * void octeon_cop2_save(struct octeon_cop2_state *a0)
93 */
94 .align 7
95 .set push
96 .set noreorder
97 LEAF(octeon_cop2_save)
98
99 dmfc0 t9, $9,7 /* CvmCtl register. */
100
101 /* Save the COP2 CRC state */
102 dmfc2 t0, 0x0201
103 dmfc2 t1, 0x0202
104 dmfc2 t2, 0x0200
105 sd t0, OCTEON_CP2_CRC_IV(a0)
106 sd t1, OCTEON_CP2_CRC_LENGTH(a0)
107 /* Skip next instructions if CvmCtl[NODFA_CP2] set */
108 bbit1 t9, 28, 1f
109 sd t2, OCTEON_CP2_CRC_POLY(a0)
110
111 /* Save the LLM state */
112 dmfc2 t0, 0x0402
113 dmfc2 t1, 0x040A
114 sd t0, OCTEON_CP2_LLM_DAT(a0)
115
1161: bbit1 t9, 26, 3f /* done if CvmCtl[NOCRYPTO] set */
117 sd t1, OCTEON_CP2_LLM_DAT+8(a0)
118
119 /* Save the COP2 crypto state */
120 /* this part is mostly common to both pass 1 and later revisions */
121 dmfc2 t0, 0x0084
122 dmfc2 t1, 0x0080
123 dmfc2 t2, 0x0081
124 dmfc2 t3, 0x0082
125 sd t0, OCTEON_CP2_3DES_IV(a0)
126 dmfc2 t0, 0x0088
127 sd t1, OCTEON_CP2_3DES_KEY(a0)
128 dmfc2 t1, 0x0111 /* only necessary for pass 1 */
129 sd t2, OCTEON_CP2_3DES_KEY+8(a0)
130 dmfc2 t2, 0x0102
131 sd t3, OCTEON_CP2_3DES_KEY+16(a0)
132 dmfc2 t3, 0x0103
133 sd t0, OCTEON_CP2_3DES_RESULT(a0)
134 dmfc2 t0, 0x0104
135 sd t1, OCTEON_CP2_AES_INP0(a0) /* only necessary for pass 1 */
136 dmfc2 t1, 0x0105
137 sd t2, OCTEON_CP2_AES_IV(a0)
138 dmfc2 t2, 0x0106
139 sd t3, OCTEON_CP2_AES_IV+8(a0)
140 dmfc2 t3, 0x0107
141 sd t0, OCTEON_CP2_AES_KEY(a0)
142 dmfc2 t0, 0x0110
143 sd t1, OCTEON_CP2_AES_KEY+8(a0)
144 dmfc2 t1, 0x0100
145 sd t2, OCTEON_CP2_AES_KEY+16(a0)
146 dmfc2 t2, 0x0101
147 sd t3, OCTEON_CP2_AES_KEY+24(a0)
148 mfc0 v0, $15,0 /* Get the processor ID register */
149 sd t0, OCTEON_CP2_AES_KEYLEN(a0)
150 li v1, 0x000d0000 /* This is the processor ID of Octeon Pass1 */
151 sd t1, OCTEON_CP2_AES_RESULT(a0)
152 /* Skip to the Pass1 version of the remainder of the COP2 state */
153 beq v0, v1, 2f
154 sd t2, OCTEON_CP2_AES_RESULT+8(a0)
155
156 /* the non-pass1 state when !CvmCtl[NOCRYPTO] */
157 dmfc2 t1, 0x0240
158 dmfc2 t2, 0x0241
159 ori v1, v1, 0x9500 /* lowest OCTEON III PrId*/
160 dmfc2 t3, 0x0242
161 subu v1, v0, v1 /* prid - lowest OCTEON III PrId */
162 dmfc2 t0, 0x0243
163 sd t1, OCTEON_CP2_HSH_DATW(a0)
164 dmfc2 t1, 0x0244
165 sd t2, OCTEON_CP2_HSH_DATW+8(a0)
166 dmfc2 t2, 0x0245
167 sd t3, OCTEON_CP2_HSH_DATW+16(a0)
168 dmfc2 t3, 0x0246
169 sd t0, OCTEON_CP2_HSH_DATW+24(a0)
170 dmfc2 t0, 0x0247
171 sd t1, OCTEON_CP2_HSH_DATW+32(a0)
172 dmfc2 t1, 0x0248
173 sd t2, OCTEON_CP2_HSH_DATW+40(a0)
174 dmfc2 t2, 0x0249
175 sd t3, OCTEON_CP2_HSH_DATW+48(a0)
176 dmfc2 t3, 0x024A
177 sd t0, OCTEON_CP2_HSH_DATW+56(a0)
178 dmfc2 t0, 0x024B
179 sd t1, OCTEON_CP2_HSH_DATW+64(a0)
180 dmfc2 t1, 0x024C
181 sd t2, OCTEON_CP2_HSH_DATW+72(a0)
182 dmfc2 t2, 0x024D
183 sd t3, OCTEON_CP2_HSH_DATW+80(a0)
184 dmfc2 t3, 0x024E
185 sd t0, OCTEON_CP2_HSH_DATW+88(a0)
186 dmfc2 t0, 0x0250
187 sd t1, OCTEON_CP2_HSH_DATW+96(a0)
188 dmfc2 t1, 0x0251
189 sd t2, OCTEON_CP2_HSH_DATW+104(a0)
190 dmfc2 t2, 0x0252
191 sd t3, OCTEON_CP2_HSH_DATW+112(a0)
192 dmfc2 t3, 0x0253
193 sd t0, OCTEON_CP2_HSH_IVW(a0)
194 dmfc2 t0, 0x0254
195 sd t1, OCTEON_CP2_HSH_IVW+8(a0)
196 dmfc2 t1, 0x0255
197 sd t2, OCTEON_CP2_HSH_IVW+16(a0)
198 dmfc2 t2, 0x0256
199 sd t3, OCTEON_CP2_HSH_IVW+24(a0)
200 dmfc2 t3, 0x0257
201 sd t0, OCTEON_CP2_HSH_IVW+32(a0)
202 dmfc2 t0, 0x0258
203 sd t1, OCTEON_CP2_HSH_IVW+40(a0)
204 dmfc2 t1, 0x0259
205 sd t2, OCTEON_CP2_HSH_IVW+48(a0)
206 dmfc2 t2, 0x025E
207 sd t3, OCTEON_CP2_HSH_IVW+56(a0)
208 dmfc2 t3, 0x025A
209 sd t0, OCTEON_CP2_GFM_MULT(a0)
210 dmfc2 t0, 0x025B
211 sd t1, OCTEON_CP2_GFM_MULT+8(a0)
212 sd t2, OCTEON_CP2_GFM_POLY(a0)
213 sd t3, OCTEON_CP2_GFM_RESULT(a0)
214 bltz v1, 4f
215 sd t0, OCTEON_CP2_GFM_RESULT+8(a0)
216 /* OCTEON III things*/
217 dmfc2 t0, 0x024F
218 dmfc2 t1, 0x0050
219 sd t0, OCTEON_CP2_SHA3(a0)
220 sd t1, OCTEON_CP2_SHA3+8(a0)
2214:
222 jr ra
223 nop
224
2252: /* pass 1 special stuff when !CvmCtl[NOCRYPTO] */
226 dmfc2 t3, 0x0040
227 dmfc2 t0, 0x0041
228 dmfc2 t1, 0x0042
229 dmfc2 t2, 0x0043
230 sd t3, OCTEON_CP2_HSH_DATW(a0)
231 dmfc2 t3, 0x0044
232 sd t0, OCTEON_CP2_HSH_DATW+8(a0)
233 dmfc2 t0, 0x0045
234 sd t1, OCTEON_CP2_HSH_DATW+16(a0)
235 dmfc2 t1, 0x0046
236 sd t2, OCTEON_CP2_HSH_DATW+24(a0)
237 dmfc2 t2, 0x0048
238 sd t3, OCTEON_CP2_HSH_DATW+32(a0)
239 dmfc2 t3, 0x0049
240 sd t0, OCTEON_CP2_HSH_DATW+40(a0)
241 dmfc2 t0, 0x004A
242 sd t1, OCTEON_CP2_HSH_DATW+48(a0)
243 sd t2, OCTEON_CP2_HSH_IVW(a0)
244 sd t3, OCTEON_CP2_HSH_IVW+8(a0)
245 sd t0, OCTEON_CP2_HSH_IVW+16(a0)
246
2473: /* pass 1 or CvmCtl[NOCRYPTO] set */
248 jr ra
249 nop
250 END(octeon_cop2_save)
251 .set pop
252
253/*
254 * void octeon_cop2_restore(struct octeon_cop2_state *a0)
255 */
256 .align 7
257 .set push
258 .set noreorder
259 LEAF(octeon_cop2_restore)
260 /* First cache line was prefetched before the call */
261 pref 4, 128(a0)
262 dmfc0 t9, $9,7 /* CvmCtl register. */
263
264 pref 4, 256(a0)
265 ld t0, OCTEON_CP2_CRC_IV(a0)
266 pref 4, 384(a0)
267 ld t1, OCTEON_CP2_CRC_LENGTH(a0)
268 ld t2, OCTEON_CP2_CRC_POLY(a0)
269
270 /* Restore the COP2 CRC state */
271 dmtc2 t0, 0x0201
272 dmtc2 t1, 0x1202
273 bbit1 t9, 28, 2f /* Skip LLM if CvmCtl[NODFA_CP2] is set */
274 dmtc2 t2, 0x4200
275
276 /* Restore the LLM state */
277 ld t0, OCTEON_CP2_LLM_DAT(a0)
278 ld t1, OCTEON_CP2_LLM_DAT+8(a0)
279 dmtc2 t0, 0x0402
280 dmtc2 t1, 0x040A
281
2822:
283 bbit1 t9, 26, done_restore /* done if CvmCtl[NOCRYPTO] set */
284 nop
285
286 /* Restore the COP2 crypto state common to pass 1 and pass 2 */
287 ld t0, OCTEON_CP2_3DES_IV(a0)
288 ld t1, OCTEON_CP2_3DES_KEY(a0)
289 ld t2, OCTEON_CP2_3DES_KEY+8(a0)
290 dmtc2 t0, 0x0084
291 ld t0, OCTEON_CP2_3DES_KEY+16(a0)
292 dmtc2 t1, 0x0080
293 ld t1, OCTEON_CP2_3DES_RESULT(a0)
294 dmtc2 t2, 0x0081
295 ld t2, OCTEON_CP2_AES_INP0(a0) /* only really needed for pass 1 */
296 dmtc2 t0, 0x0082
297 ld t0, OCTEON_CP2_AES_IV(a0)
298 dmtc2 t1, 0x0098
299 ld t1, OCTEON_CP2_AES_IV+8(a0)
300 dmtc2 t2, 0x010A /* only really needed for pass 1 */
301 ld t2, OCTEON_CP2_AES_KEY(a0)
302 dmtc2 t0, 0x0102
303 ld t0, OCTEON_CP2_AES_KEY+8(a0)
304 dmtc2 t1, 0x0103
305 ld t1, OCTEON_CP2_AES_KEY+16(a0)
306 dmtc2 t2, 0x0104
307 ld t2, OCTEON_CP2_AES_KEY+24(a0)
308 dmtc2 t0, 0x0105
309 ld t0, OCTEON_CP2_AES_KEYLEN(a0)
310 dmtc2 t1, 0x0106
311 ld t1, OCTEON_CP2_AES_RESULT(a0)
312 dmtc2 t2, 0x0107
313 ld t2, OCTEON_CP2_AES_RESULT+8(a0)
314 mfc0 t3, $15,0 /* Get the processor ID register */
315 dmtc2 t0, 0x0110
316 li v0, 0x000d0000 /* This is the processor ID of Octeon Pass1 */
317 dmtc2 t1, 0x0100
318 bne v0, t3, 3f /* Skip the next stuff for non-pass1 */
319 dmtc2 t2, 0x0101
320
321 /* this code is specific for pass 1 */
322 ld t0, OCTEON_CP2_HSH_DATW(a0)
323 ld t1, OCTEON_CP2_HSH_DATW+8(a0)
324 ld t2, OCTEON_CP2_HSH_DATW+16(a0)
325 dmtc2 t0, 0x0040
326 ld t0, OCTEON_CP2_HSH_DATW+24(a0)
327 dmtc2 t1, 0x0041
328 ld t1, OCTEON_CP2_HSH_DATW+32(a0)
329 dmtc2 t2, 0x0042
330 ld t2, OCTEON_CP2_HSH_DATW+40(a0)
331 dmtc2 t0, 0x0043
332 ld t0, OCTEON_CP2_HSH_DATW+48(a0)
333 dmtc2 t1, 0x0044
334 ld t1, OCTEON_CP2_HSH_IVW(a0)
335 dmtc2 t2, 0x0045
336 ld t2, OCTEON_CP2_HSH_IVW+8(a0)
337 dmtc2 t0, 0x0046
338 ld t0, OCTEON_CP2_HSH_IVW+16(a0)
339 dmtc2 t1, 0x0048
340 dmtc2 t2, 0x0049
341 b done_restore /* unconditional branch */
342 dmtc2 t0, 0x004A
343
3443: /* this is post-pass1 code */
345 ld t2, OCTEON_CP2_HSH_DATW(a0)
346 ori v0, v0, 0x9500 /* lowest OCTEON III PrId*/
347 ld t0, OCTEON_CP2_HSH_DATW+8(a0)
348 ld t1, OCTEON_CP2_HSH_DATW+16(a0)
349 dmtc2 t2, 0x0240
350 ld t2, OCTEON_CP2_HSH_DATW+24(a0)
351 dmtc2 t0, 0x0241
352 ld t0, OCTEON_CP2_HSH_DATW+32(a0)
353 dmtc2 t1, 0x0242
354 ld t1, OCTEON_CP2_HSH_DATW+40(a0)
355 dmtc2 t2, 0x0243
356 ld t2, OCTEON_CP2_HSH_DATW+48(a0)
357 dmtc2 t0, 0x0244
358 ld t0, OCTEON_CP2_HSH_DATW+56(a0)
359 dmtc2 t1, 0x0245
360 ld t1, OCTEON_CP2_HSH_DATW+64(a0)
361 dmtc2 t2, 0x0246
362 ld t2, OCTEON_CP2_HSH_DATW+72(a0)
363 dmtc2 t0, 0x0247
364 ld t0, OCTEON_CP2_HSH_DATW+80(a0)
365 dmtc2 t1, 0x0248
366 ld t1, OCTEON_CP2_HSH_DATW+88(a0)
367 dmtc2 t2, 0x0249
368 ld t2, OCTEON_CP2_HSH_DATW+96(a0)
369 dmtc2 t0, 0x024A
370 ld t0, OCTEON_CP2_HSH_DATW+104(a0)
371 dmtc2 t1, 0x024B
372 ld t1, OCTEON_CP2_HSH_DATW+112(a0)
373 dmtc2 t2, 0x024C
374 ld t2, OCTEON_CP2_HSH_IVW(a0)
375 dmtc2 t0, 0x024D
376 ld t0, OCTEON_CP2_HSH_IVW+8(a0)
377 dmtc2 t1, 0x024E
378 ld t1, OCTEON_CP2_HSH_IVW+16(a0)
379 dmtc2 t2, 0x0250
380 ld t2, OCTEON_CP2_HSH_IVW+24(a0)
381 dmtc2 t0, 0x0251
382 ld t0, OCTEON_CP2_HSH_IVW+32(a0)
383 dmtc2 t1, 0x0252
384 ld t1, OCTEON_CP2_HSH_IVW+40(a0)
385 dmtc2 t2, 0x0253
386 ld t2, OCTEON_CP2_HSH_IVW+48(a0)
387 dmtc2 t0, 0x0254
388 ld t0, OCTEON_CP2_HSH_IVW+56(a0)
389 dmtc2 t1, 0x0255
390 ld t1, OCTEON_CP2_GFM_MULT(a0)
391 dmtc2 t2, 0x0256
392 ld t2, OCTEON_CP2_GFM_MULT+8(a0)
393 dmtc2 t0, 0x0257
394 ld t0, OCTEON_CP2_GFM_POLY(a0)
395 dmtc2 t1, 0x0258
396 ld t1, OCTEON_CP2_GFM_RESULT(a0)
397 dmtc2 t2, 0x0259
398 ld t2, OCTEON_CP2_GFM_RESULT+8(a0)
399 dmtc2 t0, 0x025E
400 subu v0, t3, v0 /* prid - lowest OCTEON III PrId */
401 dmtc2 t1, 0x025A
402 bltz v0, done_restore
403 dmtc2 t2, 0x025B
404 /* OCTEON III things*/
405 ld t0, OCTEON_CP2_SHA3(a0)
406 ld t1, OCTEON_CP2_SHA3+8(a0)
407 dmtc2 t0, 0x0051
408 dmtc2 t1, 0x0050
409done_restore:
410 jr ra
411 nop
412 END(octeon_cop2_restore)
413 .set pop
414
415/*
416 * void octeon_mult_save()
417 * sp is assumed to point to a struct pt_regs
418 *
419 * NOTE: This is called in SAVE_TEMP in stackframe.h. It can
420 * safely modify v1,k0, k1,$10-$15, and $24. It will
421 * be overwritten with a processor specific version of the code.
422 */
423 .p2align 7
424 .set push
425 .set noreorder
426 LEAF(octeon_mult_save)
427 jr ra
428 nop
429 .space 30 * 4, 0
430octeon_mult_save_end:
431 EXPORT(octeon_mult_save_end)
432 END(octeon_mult_save)
433
434 LEAF(octeon_mult_save2)
435 /* Save the multiplier state OCTEON II and earlier*/
436 v3mulu k0, $0, $0
437 v3mulu k1, $0, $0
438 sd k0, PT_MTP(sp) /* PT_MTP has P0 */
439 v3mulu k0, $0, $0
440 sd k1, PT_MTP+8(sp) /* PT_MTP+8 has P1 */
441 ori k1, $0, 1
442 v3mulu k1, k1, $0
443 sd k0, PT_MTP+16(sp) /* PT_MTP+16 has P2 */
444 v3mulu k0, $0, $0
445 sd k1, PT_MPL(sp) /* PT_MPL has MPL0 */
446 v3mulu k1, $0, $0
447 sd k0, PT_MPL+8(sp) /* PT_MPL+8 has MPL1 */
448 jr ra
449 sd k1, PT_MPL+16(sp) /* PT_MPL+16 has MPL2 */
450octeon_mult_save2_end:
451 EXPORT(octeon_mult_save2_end)
452 END(octeon_mult_save2)
453
454 LEAF(octeon_mult_save3)
455 /* Save the multiplier state OCTEON III */
456 v3mulu $10, $0, $0 /* read P0 */
457 v3mulu $11, $0, $0 /* read P1 */
458 v3mulu $12, $0, $0 /* read P2 */
459 sd $10, PT_MTP+(0*8)(sp) /* store P0 */
460 v3mulu $10, $0, $0 /* read P3 */
461 sd $11, PT_MTP+(1*8)(sp) /* store P1 */
462 v3mulu $11, $0, $0 /* read P4 */
463 sd $12, PT_MTP+(2*8)(sp) /* store P2 */
464 ori $13, $0, 1
465 v3mulu $12, $0, $0 /* read P5 */
466 sd $10, PT_MTP+(3*8)(sp) /* store P3 */
467 v3mulu $13, $13, $0 /* P4-P0 = MPL5-MPL1, $13 = MPL0 */
468 sd $11, PT_MTP+(4*8)(sp) /* store P4 */
469 v3mulu $10, $0, $0 /* read MPL1 */
470 sd $12, PT_MTP+(5*8)(sp) /* store P5 */
471 v3mulu $11, $0, $0 /* read MPL2 */
472 sd $13, PT_MPL+(0*8)(sp) /* store MPL0 */
473 v3mulu $12, $0, $0 /* read MPL3 */
474 sd $10, PT_MPL+(1*8)(sp) /* store MPL1 */
475 v3mulu $10, $0, $0 /* read MPL4 */
476 sd $11, PT_MPL+(2*8)(sp) /* store MPL2 */
477 v3mulu $11, $0, $0 /* read MPL5 */
478 sd $12, PT_MPL+(3*8)(sp) /* store MPL3 */
479 sd $10, PT_MPL+(4*8)(sp) /* store MPL4 */
480 jr ra
481 sd $11, PT_MPL+(5*8)(sp) /* store MPL5 */
482octeon_mult_save3_end:
483 EXPORT(octeon_mult_save3_end)
484 END(octeon_mult_save3)
485 .set pop
486
487/*
488 * void octeon_mult_restore()
489 * sp is assumed to point to a struct pt_regs
490 *
491 * NOTE: This is called in RESTORE_TEMP in stackframe.h.
492 */
493 .p2align 7
494 .set push
495 .set noreorder
496 LEAF(octeon_mult_restore)
497 jr ra
498 nop
499 .space 30 * 4, 0
500octeon_mult_restore_end:
501 EXPORT(octeon_mult_restore_end)
502 END(octeon_mult_restore)
503
504 LEAF(octeon_mult_restore2)
505 ld v0, PT_MPL(sp) /* MPL0 */
506 ld v1, PT_MPL+8(sp) /* MPL1 */
507 ld k0, PT_MPL+16(sp) /* MPL2 */
508 /* Restore the multiplier state */
509 ld k1, PT_MTP+16(sp) /* P2 */
510 mtm0 v0 /* MPL0 */
511 ld v0, PT_MTP+8(sp) /* P1 */
512 mtm1 v1 /* MPL1 */
513 ld v1, PT_MTP(sp) /* P0 */
514 mtm2 k0 /* MPL2 */
515 mtp2 k1 /* P2 */
516 mtp1 v0 /* P1 */
517 jr ra
518 mtp0 v1 /* P0 */
519octeon_mult_restore2_end:
520 EXPORT(octeon_mult_restore2_end)
521 END(octeon_mult_restore2)
522
523 LEAF(octeon_mult_restore3)
524 ld $12, PT_MPL+(0*8)(sp) /* read MPL0 */
525 ld $13, PT_MPL+(3*8)(sp) /* read MPL3 */
526 ld $10, PT_MPL+(1*8)(sp) /* read MPL1 */
527 ld $11, PT_MPL+(4*8)(sp) /* read MPL4 */
528 .word 0x718d0008
529 /* mtm0 $12, $13 restore MPL0 and MPL3 */
530 ld $12, PT_MPL+(2*8)(sp) /* read MPL2 */
531 .word 0x714b000c
532 /* mtm1 $10, $11 restore MPL1 and MPL4 */
533 ld $13, PT_MPL+(5*8)(sp) /* read MPL5 */
534 ld $10, PT_MTP+(0*8)(sp) /* read P0 */
535 ld $11, PT_MTP+(3*8)(sp) /* read P3 */
536 .word 0x718d000d
537 /* mtm2 $12, $13 restore MPL2 and MPL5 */
538 ld $12, PT_MTP+(1*8)(sp) /* read P1 */
539 .word 0x714b0009
540 /* mtp0 $10, $11 restore P0 and P3 */
541 ld $13, PT_MTP+(4*8)(sp) /* read P4 */
542 ld $10, PT_MTP+(2*8)(sp) /* read P2 */
543 ld $11, PT_MTP+(5*8)(sp) /* read P5 */
544 .word 0x718d000a
545 /* mtp1 $12, $13 restore P1 and P4 */
546 jr ra
547 .word 0x714b000b
548 /* mtp2 $10, $11 restore P2 and P5 */
549
550octeon_mult_restore3_end:
551 EXPORT(octeon_mult_restore3_end)
552 END(octeon_mult_restore3)
553 .set pop