git.oblomov.eu Git - linux-2.6/blob - arch/h8300/kernel/entry.S

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