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