c6e289b5f1f284f4a5b3c11b8acba29bab3fa4c6
[releases.git] / entry.S
1 /* SPDX-License-Identifier: GPL-2.0 */
2 /*
3  *
4  *  linux/arch/h8300/kernel/entry.S
5  *
6  *  Yoshinori Sato <ysato@users.sourceforge.jp>
7  *  David McCullough <davidm@snapgear.com>
8  *
9  */
10
11 /*
12  *  entry.S
13  *  include exception/interrupt gateway
14  *          system call entry
15  */
16
17 #include <linux/sys.h>
18 #include <asm/unistd.h>
19 #include <asm/setup.h>
20 #include <asm/segment.h>
21 #include <asm/linkage.h>
22 #include <asm/asm-offsets.h>
23 #include <asm/thread_info.h>
24 #include <asm/errno.h>
25
26 #if defined(CONFIG_CPU_H8300H)
27 #define USERRET 8
28 INTERRUPTS = 64
29         .h8300h
30         .macro  SHLL2 reg
31         shll.l  \reg
32         shll.l  \reg
33         .endm
34         .macro  SHLR2 reg
35         shlr.l  \reg
36         shlr.l  \reg
37         .endm
38         .macro  SAVEREGS
39         mov.l   er0,@-sp
40         mov.l   er1,@-sp
41         mov.l   er2,@-sp
42         mov.l   er3,@-sp
43         .endm
44         .macro  RESTOREREGS
45         mov.l   @sp+,er3
46         mov.l   @sp+,er2
47         .endm
48         .macro  SAVEEXR
49         .endm
50         .macro  RESTOREEXR
51         .endm
52 #endif
53 #if defined(CONFIG_CPU_H8S)
54 #define USERRET 10
55 #define USEREXR 8
56 INTERRUPTS = 128
57         .h8300s
58         .macro  SHLL2 reg
59         shll.l  #2,\reg
60         .endm
61         .macro  SHLR2 reg
62         shlr.l  #2,\reg
63         .endm
64         .macro  SAVEREGS
65         stm.l   er0-er3,@-sp
66         .endm
67         .macro  RESTOREREGS
68         ldm.l   @sp+,er2-er3
69         .endm
70         .macro  SAVEEXR
71         mov.w   @(USEREXR:16,er0),r1
72         mov.w   r1,@(LEXR-LER3:16,sp)           /* copy EXR */
73         .endm
74         .macro  RESTOREEXR
75         mov.w   @(LEXR-LER1:16,sp),r1           /* restore EXR */
76         mov.b   r1l,r1h
77         mov.w   r1,@(USEREXR:16,er0)
78         .endm
79 #endif
80
81
82 /* CPU context save/restore macros. */
83
84         .macro  SAVE_ALL
85         mov.l   er0,@-sp
86         stc     ccr,r0l                         /* check kernel mode */
87         btst    #4,r0l
88         bne     5f
89
90         /* user mode */
91         mov.l   sp,@_sw_usp
92         mov.l   @sp,er0                         /* restore saved er0 */
93         orc     #0x10,ccr                       /* switch kernel stack */
94         mov.l   @_sw_ksp,sp
95         sub.l   #(LRET-LORIG),sp                /* allocate LORIG - LRET */
96         SAVEREGS
97         mov.l   @_sw_usp,er0
98         mov.l   @(USERRET:16,er0),er1           /* copy the RET addr */
99         mov.l   er1,@(LRET-LER3:16,sp)
100         SAVEEXR
101
102         mov.l   @(LORIG-LER3:16,sp),er0
103         mov.l   er0,@(LER0-LER3:16,sp)          /* copy ER0 */
104         mov.w   e1,r1                           /* e1 highbyte = ccr */
105         and     #0xef,r1h                       /* mask mode? flag */
106         bra     6f
107 5:
108         /* kernel mode */
109         mov.l   @sp,er0                         /* restore saved er0 */
110         subs    #2,sp                           /* set dummy ccr */
111         subs    #4,sp                           /* set dummp sp */
112         SAVEREGS
113         mov.w   @(LRET-LER3:16,sp),r1           /* copy old ccr */
114 6:
115         mov.b   r1h,r1l
116         mov.b   #0,r1h
117         mov.w   r1,@(LCCR-LER3:16,sp)           /* set ccr */
118         mov.l   @_sw_usp,er2
119         mov.l   er2,@(LSP-LER3:16,sp)           /* set usp */
120         mov.l   er6,@-sp                        /* syscall arg #6 */
121         mov.l   er5,@-sp                        /* syscall arg #5 */
122         mov.l   er4,@-sp                        /* syscall arg #4 */
123         .endm                                   /* r1 = ccr */
124
125         .macro  RESTORE_ALL
126         mov.l   @sp+,er4
127         mov.l   @sp+,er5
128         mov.l   @sp+,er6
129         RESTOREREGS
130         mov.w   @(LCCR-LER1:16,sp),r0           /* check kernel mode */
131         btst    #4,r0l
132         bne     7f
133
134         orc     #0xc0,ccr
135         mov.l   @(LSP-LER1:16,sp),er0
136         mov.l   @(LER0-LER1:16,sp),er1          /* restore ER0 */
137         mov.l   er1,@er0
138         RESTOREEXR
139         mov.w   @(LCCR-LER1:16,sp),r1           /* restore the RET addr */
140         mov.b   r1l,r1h
141         mov.b   @(LRET+1-LER1:16,sp),r1l
142         mov.w   r1,e1
143         mov.w   @(LRET+2-LER1:16,sp),r1
144         mov.l   er1,@(USERRET:16,er0)
145
146         mov.l   @sp+,er1
147         add.l   #(LRET-LER1),sp                 /* remove LORIG - LRET */
148         mov.l   sp,@_sw_ksp
149         andc    #0xef,ccr                       /* switch to user mode */
150         mov.l   er0,sp
151         bra     8f
152 7:
153         mov.l   @sp+,er1
154         add.l   #10,sp
155 8:
156         mov.l   @sp+,er0
157         adds    #4,sp                           /* remove the sw created LVEC */
158         rte
159         .endm
160
161 .globl _system_call
162 .globl ret_from_exception
163 .globl ret_from_fork
164 .globl ret_from_kernel_thread
165 .globl ret_from_interrupt
166 .globl _interrupt_redirect_table
167 .globl _sw_ksp,_sw_usp
168 .globl _resume
169 .globl _interrupt_entry
170 .globl _trace_break
171 .globl _nmi
172
173 #if defined(CONFIG_ROMKERNEL)
174         .section .int_redirect,"ax"
175 _interrupt_redirect_table:
176 #if defined(CONFIG_CPU_H8300H)
177         .rept   7
178         .long   0
179         .endr
180 #endif
181 #if defined(CONFIG_CPU_H8S)
182         .rept   5
183         .long   0
184         .endr
185         jmp     @_trace_break
186         .long   0
187 #endif
188
189         jsr     @_interrupt_entry               /* NMI */
190         jmp     @_system_call                   /* TRAPA #0 (System call) */
191         .long   0
192 #if defined(CONFIG_KGDB)
193         jmp     @_kgdb_trap
194 #else
195         .long   0
196 #endif
197         jmp     @_trace_break                   /* TRAPA #3 (breakpoint) */
198         .rept   INTERRUPTS-12
199         jsr     @_interrupt_entry
200         .endr
201 #endif
202 #if defined(CONFIG_RAMKERNEL)
203 .globl _interrupt_redirect_table
204         .section .bss
205 _interrupt_redirect_table:
206         .space  4
207 #endif
208
209         .section .text
210         .align  2
211 _interrupt_entry:
212         SAVE_ALL
213 /* r1l is saved ccr */
214         mov.l   sp,er0
215         add.l   #LVEC,er0
216         btst    #4,r1l
217         bne     1f
218         /* user LVEC */
219         mov.l   @_sw_usp,er0
220         adds    #4,er0
221 1:
222         mov.l   @er0,er0                        /* LVEC address */
223 #if defined(CONFIG_ROMKERNEL)
224         sub.l   #_interrupt_redirect_table,er0
225 #endif
226 #if defined(CONFIG_RAMKERNEL)
227         mov.l   @_interrupt_redirect_table,er1
228         sub.l   er1,er0
229 #endif
230         SHLR2   er0
231         dec.l   #1,er0
232         mov.l   sp,er1
233         subs    #4,er1                          /* adjust ret_pc */
234 #if defined(CONFIG_CPU_H8S)
235         orc     #7,exr
236 #endif
237         jsr     @do_IRQ
238         jmp     @ret_from_interrupt
239
240 _system_call:
241         subs    #4,sp                           /* dummy LVEC */
242         SAVE_ALL
243         /* er0: syscall nr */
244         andc    #0xbf,ccr
245         mov.l   er0,er4
246
247         /* save top of frame */
248         mov.l   sp,er0
249         jsr     @set_esp0
250         andc    #0x3f,ccr
251         mov.l   sp,er2
252         and.w   #0xe000,r2
253         mov.l   @(TI_FLAGS:16,er2),er2
254         and.w   #_TIF_WORK_SYSCALL_MASK,r2
255         beq     1f
256         mov.l   sp,er0
257         jsr     @do_syscall_trace_enter
258 1:
259         cmp.l   #__NR_syscalls,er4
260         bcc     badsys
261         SHLL2   er4
262         mov.l   #_sys_call_table,er0
263         add.l   er4,er0
264         mov.l   @er0,er4
265         beq     ret_from_exception:16
266         mov.l   @(LER1:16,sp),er0
267         mov.l   @(LER2:16,sp),er1
268         mov.l   @(LER3:16,sp),er2
269         jsr     @er4
270         mov.l   er0,@(LER0:16,sp)               /* save the return value */
271         mov.l   sp,er2
272         and.w   #0xe000,r2
273         mov.l   @(TI_FLAGS:16,er2),er2
274         and.w   #_TIF_WORK_SYSCALL_MASK,r2
275         beq     2f
276         mov.l   sp,er0
277         jsr     @do_syscall_trace_leave
278 2:
279         orc     #0xc0,ccr
280         bra     resume_userspace
281
282 badsys:
283         mov.l   #-ENOSYS,er0
284         mov.l   er0,@(LER0:16,sp)
285         bra     resume_userspace
286
287 #if !defined(CONFIG_PREEMPTION)
288 #define resume_kernel restore_all
289 #endif
290
291 ret_from_exception:
292 #if defined(CONFIG_PREEMPTION)
293         orc     #0xc0,ccr
294 #endif
295 ret_from_interrupt:
296         mov.b   @(LCCR+1:16,sp),r0l
297         btst    #4,r0l
298         bne     resume_kernel:16        /* return from kernel */
299 resume_userspace:
300         andc    #0xbf,ccr
301         mov.l   sp,er4
302         and.w   #0xe000,r4              /* er4 <- current thread info */
303         mov.l   @(TI_FLAGS:16,er4),er1
304         and.l   #_TIF_WORK_MASK,er1
305         beq     restore_all:8
306 work_pending:
307         btst    #TIF_NEED_RESCHED,r1l
308         bne     work_resched:8
309         /* work notifysig */
310         mov.l   sp,er0
311         subs    #4,er0                  /* er0: pt_regs */
312         jsr     @do_notify_resume
313         bra     resume_userspace:8
314 work_resched:
315         mov.l   sp,er0
316         jsr     @set_esp0
317         jsr     @schedule
318         bra     resume_userspace:8
319 restore_all:
320         RESTORE_ALL                     /* Does RTE */
321
322 #if defined(CONFIG_PREEMPTION)
323 resume_kernel:
324         mov.l   @(TI_PRE_COUNT:16,er4),er0
325         bne     restore_all:8
326 need_resched:
327         mov.l   @(TI_FLAGS:16,er4),er0
328         btst    #TIF_NEED_RESCHED,r0l
329         beq     restore_all:8
330         mov.b   @(LCCR+1:16,sp),r0l     /* Interrupt Enabled? */
331         bmi     restore_all:8
332         mov.l   sp,er0
333         jsr     @set_esp0
334         jsr     @preempt_schedule_irq
335         bra     need_resched:8
336 #endif
337
338 ret_from_fork:
339         mov.l   er2,er0
340         jsr     @schedule_tail
341         jmp     @ret_from_exception
342
343 ret_from_kernel_thread:
344         mov.l   er2,er0
345         jsr     @schedule_tail
346         mov.l   @(LER4:16,sp),er0
347         mov.l   @(LER5:16,sp),er1
348         jsr     @er1
349         jmp     @ret_from_exception
350
351 _resume:
352         /*
353          * Beware - when entering resume, offset of tss is in d1,
354          * prev (the current task) is in a0, next (the new task)
355          * is in a1 and d2.b is non-zero if the mm structure is
356          * shared between the tasks, so don't change these
357          * registers until their contents are no longer needed.
358          */
359
360         /* save sr */
361         sub.w   r3,r3
362         stc     ccr,r3l
363         mov.w   r3,@(THREAD_CCR+2:16,er0)
364
365         /* disable interrupts */
366         orc     #0xc0,ccr
367         mov.l   @_sw_usp,er3
368         mov.l   er3,@(THREAD_USP:16,er0)
369         mov.l   sp,@(THREAD_KSP:16,er0)
370
371         /* Skip address space switching if they are the same. */
372         /* FIXME: what did we hack out of here, this does nothing! */
373
374         mov.l   @(THREAD_USP:16,er1),er0
375         mov.l   er0,@_sw_usp
376         mov.l   @(THREAD_KSP:16,er1),sp
377
378         /* restore status register */
379         mov.w   @(THREAD_CCR+2:16,er1),r3
380
381         ldc     r3l,ccr
382         rts
383
384 _trace_break:
385         subs    #4,sp
386         SAVE_ALL
387         sub.l   er1,er1
388         dec.l   #1,er1
389         mov.l   er1,@(LORIG,sp)
390         mov.l   sp,er0
391         jsr     @set_esp0
392         mov.l   @_sw_usp,er0
393         mov.l   @er0,er1
394         mov.w   @(-2:16,er1),r2
395         cmp.w   #0x5730,r2
396         beq     1f
397         subs    #2,er1
398         mov.l   er1,@er0
399 1:
400         and.w   #0xff,e1
401         mov.l   er1,er0
402         jsr     @trace_trap
403         jmp     @ret_from_exception
404
405 _nmi:
406         subs    #4, sp
407         mov.l   er0, @-sp
408         mov.l   @_interrupt_redirect_table, er0
409         add.l   #8*4, er0
410         mov.l   er0, @(4,sp)
411         mov.l   @sp+, er0
412         jmp     @_interrupt_entry
413
414 #if defined(CONFIG_KGDB)
415 _kgdb_trap:
416         subs    #4,sp
417         SAVE_ALL
418         mov.l   sp,er0
419         add.l   #LRET,er0
420         mov.l   er0,@(LSP,sp)
421         jsr     @set_esp0
422         mov.l   sp,er0
423         subs    #4,er0
424         jsr     @h8300_kgdb_trap
425         jmp     @ret_from_exception
426 #endif
427
428         .section        .bss
429 _sw_ksp:
430         .space  4
431 _sw_usp:
432         .space  4
433
434         .end