| 1 |
/* SPDX-License-Identifier: GPL-2.0 */ |
| 2 |
#ifndef __ASM_SH_SWITCH_TO_32_H |
| 3 |
#define __ASM_SH_SWITCH_TO_32_H |
| 4 |
|
| 5 |
#ifdef CONFIG_SH_DSP |
| 6 |
|
| 7 |
#define is_dsp_enabled(tsk) \ |
| 8 |
(!!(tsk->thread.dsp_status.status & SR_DSP)) |
| 9 |
|
| 10 |
#define __restore_dsp(tsk) \ |
| 11 |
do { \ |
| 12 |
register u32 *__ts2 __asm__ ("r2") = \ |
| 13 |
(u32 *)&tsk->thread.dsp_status; \ |
| 14 |
__asm__ __volatile__ ( \ |
| 15 |
".balign 4\n\t" \ |
| 16 |
"movs.l @r2+, a0\n\t" \ |
| 17 |
"movs.l @r2+, a1\n\t" \ |
| 18 |
"movs.l @r2+, a0g\n\t" \ |
| 19 |
"movs.l @r2+, a1g\n\t" \ |
| 20 |
"movs.l @r2+, m0\n\t" \ |
| 21 |
"movs.l @r2+, m1\n\t" \ |
| 22 |
"movs.l @r2+, x0\n\t" \ |
| 23 |
"movs.l @r2+, x1\n\t" \ |
| 24 |
"movs.l @r2+, y0\n\t" \ |
| 25 |
"movs.l @r2+, y1\n\t" \ |
| 26 |
"lds.l @r2+, dsr\n\t" \ |
| 27 |
"ldc.l @r2+, rs\n\t" \ |
| 28 |
"ldc.l @r2+, re\n\t" \ |
| 29 |
"ldc.l @r2+, mod\n\t" \ |
| 30 |
: : "r" (__ts2)); \ |
| 31 |
} while (0) |
| 32 |
|
| 33 |
#define __save_dsp(tsk) \ |
| 34 |
do { \ |
| 35 |
register u32 *__ts2 __asm__ ("r2") = \ |
| 36 |
(u32 *)&tsk->thread.dsp_status + 14; \ |
| 37 |
\ |
| 38 |
__asm__ __volatile__ ( \ |
| 39 |
".balign 4\n\t" \ |
| 40 |
"stc.l mod, @-r2\n\t" \ |
| 41 |
"stc.l re, @-r2\n\t" \ |
| 42 |
"stc.l rs, @-r2\n\t" \ |
| 43 |
"sts.l dsr, @-r2\n\t" \ |
| 44 |
"movs.l y1, @-r2\n\t" \ |
| 45 |
"movs.l y0, @-r2\n\t" \ |
| 46 |
"movs.l x1, @-r2\n\t" \ |
| 47 |
"movs.l x0, @-r2\n\t" \ |
| 48 |
"movs.l m1, @-r2\n\t" \ |
| 49 |
"movs.l m0, @-r2\n\t" \ |
| 50 |
"movs.l a1g, @-r2\n\t" \ |
| 51 |
"movs.l a0g, @-r2\n\t" \ |
| 52 |
"movs.l a1, @-r2\n\t" \ |
| 53 |
"movs.l a0, @-r2\n\t" \ |
| 54 |
: : "r" (__ts2)); \ |
| 55 |
} while (0) |
| 56 |
|
| 57 |
#else |
| 58 |
|
| 59 |
#define is_dsp_enabled(tsk) (0) |
| 60 |
#define __save_dsp(tsk) do { } while (0) |
| 61 |
#define __restore_dsp(tsk) do { } while (0) |
| 62 |
#endif |
| 63 |
|
| 64 |
struct task_struct *__switch_to(struct task_struct *prev, |
| 65 |
struct task_struct *next); |
| 66 |
|
| 67 |
/* |
| 68 |
* switch_to() should switch tasks to task nr n, first |
| 69 |
*/ |
| 70 |
#define switch_to(prev, next, last) \ |
| 71 |
do { \ |
| 72 |
register u32 *__ts1 __asm__ ("r1"); \ |
| 73 |
register u32 *__ts2 __asm__ ("r2"); \ |
| 74 |
register u32 *__ts4 __asm__ ("r4"); \ |
| 75 |
register u32 *__ts5 __asm__ ("r5"); \ |
| 76 |
register u32 *__ts6 __asm__ ("r6"); \ |
| 77 |
register u32 __ts7 __asm__ ("r7"); \ |
| 78 |
struct task_struct *__last; \ |
| 79 |
\ |
| 80 |
if (is_dsp_enabled(prev)) \ |
| 81 |
__save_dsp(prev); \ |
| 82 |
if (is_dsp_enabled(next)) \ |
| 83 |
__restore_dsp(next); \ |
| 84 |
\ |
| 85 |
__ts1 = (u32 *)&prev->thread.sp; \ |
| 86 |
__ts2 = (u32 *)&prev->thread.pc; \ |
| 87 |
__ts4 = (u32 *)prev; \ |
| 88 |
__ts5 = (u32 *)next; \ |
| 89 |
__ts6 = (u32 *)&next->thread.sp; \ |
| 90 |
__ts7 = next->thread.pc; \ |
| 91 |
\ |
| 92 |
__asm__ __volatile__ ( \ |
| 93 |
".balign 4\n\t" \ |
| 94 |
"stc.l gbr, @-r15\n\t" \ |
| 95 |
"sts.l pr, @-r15\n\t" \ |
| 96 |
"mov.l r8, @-r15\n\t" \ |
| 97 |
"mov.l r9, @-r15\n\t" \ |
| 98 |
"mov.l r10, @-r15\n\t" \ |
| 99 |
"mov.l r11, @-r15\n\t" \ |
| 100 |
"mov.l r12, @-r15\n\t" \ |
| 101 |
"mov.l r13, @-r15\n\t" \ |
| 102 |
"mov.l r14, @-r15\n\t" \ |
| 103 |
"mov.l r15, @r1\t! save SP\n\t" \ |
| 104 |
"mov.l @r6, r15\t! change to new stack\n\t" \ |
| 105 |
"mova 1f, %0\n\t" \ |
| 106 |
"mov.l %0, @r2\t! save PC\n\t" \ |
| 107 |
"mov.l 2f, %0\n\t" \ |
| 108 |
"jmp @%0\t! call __switch_to\n\t" \ |
| 109 |
" lds r7, pr\t! with return to new PC\n\t" \ |
| 110 |
".balign 4\n" \ |
| 111 |
"2:\n\t" \ |
| 112 |
".long __switch_to\n" \ |
| 113 |
"1:\n\t" \ |
| 114 |
"mov.l @r15+, r14\n\t" \ |
| 115 |
"mov.l @r15+, r13\n\t" \ |
| 116 |
"mov.l @r15+, r12\n\t" \ |
| 117 |
"mov.l @r15+, r11\n\t" \ |
| 118 |
"mov.l @r15+, r10\n\t" \ |
| 119 |
"mov.l @r15+, r9\n\t" \ |
| 120 |
"mov.l @r15+, r8\n\t" \ |
| 121 |
"lds.l @r15+, pr\n\t" \ |
| 122 |
"ldc.l @r15+, gbr\n\t" \ |
| 123 |
: "=z" (__last) \ |
| 124 |
: "r" (__ts1), "r" (__ts2), "r" (__ts4), \ |
| 125 |
"r" (__ts5), "r" (__ts6), "r" (__ts7) \ |
| 126 |
: "r3", "t"); \ |
| 127 |
\ |
| 128 |
last = __last; \ |
| 129 |
} while (0) |
| 130 |
|
| 131 |
#endif /* __ASM_SH_SWITCH_TO_32_H */ |