arch/arc/kernel/entry.S

   1 /*
   2  * Low Level Interrupts/Traps/Exceptions(non-TLB) Handling for ARC
   3  *
   4  * Copyright (C) 2004, 2007-2010, 2011-2012 Synopsys, Inc. (www.synopsys.com)
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  *
  10  * vineetg: May 2011
  11  *  -Userspace unaligned access emulation
  12  *
  13  * vineetg: Feb 2011 (ptrace low level code fixes)
  14  *  -traced syscall return code (r0) was not saved into pt_regs for restoring
  15  *   into user reg-file when traded task rets to user space.
  16  *  -syscalls needing arch-wrappers (mainly for passing sp as pt_regs)
  17  *   were not invoking post-syscall trace hook (jumping directly into
  18  *   ret_from_system_call)
  19  *
  20  * vineetg: Nov 2010:
  21  *  -Vector table jumps (@8 bytes) converted into branches (@4 bytes)
  22  *  -To maintain the slot size of 8 bytes/vector, added nop, which is
  23  *   not executed at runtime.
  24  *
  25  * vineetg: Nov 2009 (Everything needed for TIF_RESTORE_SIGMASK)
  26  *  -do_signal()invoked upon TIF_RESTORE_SIGMASK as well
  27  *  -Wrappers for sys_{,rt_}sigsuspend() nolonger needed as they don't
  28  *   need ptregs anymore
  29  *
  30  * Vineetg: Oct 2009
  31  *  -In a rare scenario, Process gets a Priv-V exception and gets scheduled
  32  *   out. Since we don't do FAKE RTIE for Priv-V, CPU excpetion state remains
  33  *   active (AE bit enabled).  This causes a double fault for a subseq valid
  34  *   exception. Thus FAKE RTIE needed in low level Priv-Violation handler.
  35  *   Instr Error could also cause similar scenario, so same there as well.
  36  *
  37  * Vineetg: March 2009 (Supporting 2 levels of Interrupts)
  38  *
  39  * Vineetg: Aug 28th 2008: Bug #94984
  40  *  -Zero Overhead Loop Context shd be cleared when entering IRQ/EXcp/Trap
  41  *   Normally CPU does this automatically, however when doing FAKE rtie,
  42  *   we need to explicitly do this. The problem in macros
  43  *   FAKE_RET_FROM_EXCPN and FAKE_RET_FROM_EXCPN_LOCK_IRQ was that this bit
  44  *   was being "CLEARED" rather then "SET". Since it is Loop INHIBIT Bit,
  45  *   setting it and not clearing it clears ZOL context
  46  *
  47  * Vineetg: May 16th, 2008
  48  *  - r25 now contains the Current Task when in kernel
  49  *
  50  * Vineetg: Dec 22, 2007
  51  *    Minor Surgery of Low Level ISR to make it SMP safe
  52  *    - MMU_SCRATCH0 Reg used for freeing up r9 in Level 1 ISR
  53  *    - _current_task is made an array of NR_CPUS
  54  *    - Access of _current_task wrapped inside a macro so that if hardware
  55  *       team agrees for a dedicated reg, no other code is touched
  56  *
  57  * Amit Bhor, Rahul Trivedi, Kanika Nema, Sameer Dhavale : Codito Tech 2004
  58  */
  59
  60 /*------------------------------------------------------------------
  61  *    Function                            ABI
  62  *------------------------------------------------------------------
  63  *
  64  *  Arguments                           r0 - r7
  65  *  Caller Saved Registers              r0 - r12
  66  *  Callee Saved Registers              r13- r25
  67  *  Global Pointer (gp)                 r26
  68  *  Frame Pointer (fp)                  r27
  69  *  Stack Pointer (sp)                  r28
  70  *  Interrupt link register (ilink1)    r29
  71  *  Interrupt link register (ilink2)    r30
  72  *  Branch link register (blink)        r31
  73  *------------------------------------------------------------------
  74  */
  75
  76         .cpu A7
  77
  78 ;############################ Vector Table #################################
  79
  80 .macro VECTOR  lbl
  81 #if 1   /* Just in case, build breaks */
  82         j   \lbl
  83 #else
  84         b   \lbl
  85         nop
  86 #endif
  87 .endm
  88
  89         .section .vector, "ax",@progbits
  90         .align 4
  91
  92 /* Each entry in the vector table must occupy 2 words. Since it is a jump
  93  * across sections (.vector to .text) we are gauranteed that 'j somewhere'
  94  * will use the 'j limm' form of the intrsuction as long as somewhere is in
  95  * a section other than .vector.
  96  */
  97
  98 ; ********* Critical System Events **********************
  99 VECTOR   res_service             ; 0x0, Restart Vector  (0x0)
 100 VECTOR   mem_service             ; 0x8, Mem exception   (0x1)
 101 VECTOR   instr_service           ; 0x10, Instrn Error   (0x2)
 102
 103 ; ******************** Device ISRs **********************
 104 #ifdef CONFIG_ARC_IRQ3_LV2
 105 VECTOR   handle_interrupt_level2
 106 #else
 107 VECTOR   handle_interrupt_level1
 108 #endif
 109
 110 VECTOR   handle_interrupt_level1
 111
 112 #ifdef CONFIG_ARC_IRQ5_LV2
 113 VECTOR   handle_interrupt_level2
 114 #else
 115 VECTOR   handle_interrupt_level1
 116 #endif
 117
 118 #ifdef CONFIG_ARC_IRQ6_LV2
 119 VECTOR   handle_interrupt_level2
 120 #else
 121 VECTOR   handle_interrupt_level1
 122 #endif
 123
 124 .rept   25
 125 VECTOR   handle_interrupt_level1 ; Other devices
 126 .endr
 127
 128 /* FOR ARC600: timer = 0x3, uart = 0x8, emac = 0x10 */
 129
 130 ; ******************** Exceptions **********************
 131 VECTOR   EV_MachineCheck         ; 0x100, Fatal Machine check   (0x20)
 132 VECTOR   EV_TLBMissI             ; 0x108, Intruction TLB miss   (0x21)
 133 VECTOR   EV_TLBMissD             ; 0x110, Data TLB miss         (0x22)
 134 VECTOR   EV_TLBProtV             ; 0x118, Protection Violation  (0x23)
 135                                  ;         or Misaligned Access
 136 VECTOR   EV_PrivilegeV           ; 0x120, Privilege Violation   (0x24)
 137 VECTOR   EV_Trap                 ; 0x128, Trap exception        (0x25)
 138 VECTOR   EV_Extension            ; 0x130, Extn Intruction Excp  (0x26)
 139
 140 .rept   24
 141 VECTOR   reserved                ; Reserved Exceptions
 142 .endr
 143
 144 #include <linux/linkage.h>   /* ARC_{EXTRY,EXIT} */
 145 #include <asm/entry.h>       /* SAVE_ALL_{INT1,INT2,SYS...} */
 146 #include <asm/errno.h>
 147 #include <asm/arcregs.h>
 148 #include <asm/irqflags.h>
 149
 150 ;##################### Scratch Mem for IRQ stack switching #############
 151
 152 ARCFP_DATA int1_saved_reg
 153         .align 32
 154         .type   int1_saved_reg, @object
 155         .size   int1_saved_reg, 4
 156 int1_saved_reg:
 157         .zero 4
 158
 159 /* Each Interrupt level needs it's own scratch */
 160 #ifdef CONFIG_ARC_COMPACT_IRQ_LEVELS
 161
 162 ARCFP_DATA int2_saved_reg
 163         .type   int2_saved_reg, @object
 164         .size   int2_saved_reg, 4
 165 int2_saved_reg:
 166         .zero 4
 167
 168 #endif
 169
 170 ; ---------------------------------------------
 171         .section .text, "ax",@progbits
 172
 173 res_service:            ; processor restart
 174         flag    0x1     ; not implemented
 175         nop
 176         nop
 177
 178 reserved:               ; processor restart
 179         rtie            ; jump to processor initializations
 180
 181 ;##################### Interrupt Handling ##############################
 182
 183 #ifdef CONFIG_ARC_COMPACT_IRQ_LEVELS
 184 ; ---------------------------------------------
 185 ;  Level 2 ISR: Can interrupt a Level 1 ISR
 186 ; ---------------------------------------------
 187 ARC_ENTRY handle_interrupt_level2
 188
 189         ; TODO-vineetg for SMP this wont work
 190         ; free up r9 as scratchpad
 191         st  r9, [@int2_saved_reg]
 192
 193         ;Which mode (user/kernel) was the system in when intr occured
 194         lr  r9, [status32_l2]
 195
 196         SWITCH_TO_KERNEL_STK
 197         SAVE_ALL_INT2
 198
 199         ;------------------------------------------------------
 200         ; if L2 IRQ interrupted a L1 ISR, disable preemption
 201         ;------------------------------------------------------
 202
 203         ld r9, [sp, PT_status32]        ; get statu32_l2 (saved in pt_regs)
 204         bbit0 r9, STATUS_A1_BIT, 1f     ; L1 not active when L2 IRQ, so normal
 205
 206         ; A1 is set in status32_l2
 207         ; bump thread_info->preempt_count (Disable preemption)
 208         GET_CURR_THR_INFO_FROM_SP   r10
 209         ld      r9, [r10, THREAD_INFO_PREEMPT_COUNT]
 210         add     r9, r9, 1
 211         st      r9, [r10, THREAD_INFO_PREEMPT_COUNT]
 212
 213 1:
 214         ;------------------------------------------------------
 215         ; setup params for Linux common ISR and invoke it
 216         ;------------------------------------------------------
 217         lr  r0, [icause2]
 218         and r0, r0, 0x1f
 219
 220         bl.d  @arch_do_IRQ
 221         mov r1, sp
 222
 223         mov r8,0x2
 224         sr r8, [AUX_IRQ_LV12]       ; clear bit in Sticky Status Reg
 225
 226         b   ret_from_exception
 227
 228 ARC_EXIT handle_interrupt_level2
 229
 230 #endif
 231
 232 ; ---------------------------------------------
 233 ;  Level 1 ISR
 234 ; ---------------------------------------------
 235 ARC_ENTRY handle_interrupt_level1
 236
 237         /* free up r9 as scratchpad */
 238 #ifdef CONFIG_SMP
 239         sr  r9, [ARC_REG_SCRATCH_DATA0]
 240 #else
 241         st   r9, [@int1_saved_reg]
 242 #endif
 243
 244         ;Which mode (user/kernel) was the system in when intr occured
 245         lr  r9, [status32_l1]
 246
 247         SWITCH_TO_KERNEL_STK
 248         SAVE_ALL_INT1
 249
 250         lr  r0, [icause1]
 251         and r0, r0, 0x1f
 252
 253         bl.d  @arch_do_IRQ
 254         mov r1, sp
 255
 256         mov r8,0x1
 257         sr r8, [AUX_IRQ_LV12]       ; clear bit in Sticky Status Reg
 258
 259         b   ret_from_exception
 260 ARC_EXIT handle_interrupt_level1
 261
 262 ;################### Non TLB Exception Handling #############################
 263
 264 ; ---------------------------------------------
 265 ; Instruction Error Exception Handler
 266 ; ---------------------------------------------
 267
 268 ARC_ENTRY instr_service
 269
 270         EXCEPTION_PROLOGUE
 271
 272         lr  r0, [efa]
 273         mov r1, sp
 274
 275         FAKE_RET_FROM_EXCPN r9
 276
 277         bl  do_insterror_or_kprobe
 278         b   ret_from_exception
 279 ARC_EXIT instr_service
 280
 281 ; ---------------------------------------------
 282 ; Memory Error Exception Handler
 283 ; ---------------------------------------------
 284
 285 ARC_ENTRY mem_service
 286
 287         EXCEPTION_PROLOGUE
 288
 289         lr  r0, [efa]
 290         mov r1, sp
 291
 292         FAKE_RET_FROM_EXCPN r9
 293
 294         bl  do_memory_error
 295         b   ret_from_exception
 296 ARC_EXIT mem_service
 297
 298 ; ---------------------------------------------
 299 ; Machine Check Exception Handler
 300 ; ---------------------------------------------
 301
 302 ARC_ENTRY EV_MachineCheck
 303
 304         EXCEPTION_PROLOGUE
 305
 306         lr  r2, [ecr]
 307         lr  r0, [efa]
 308         mov r1, sp
 309
 310         lsr     r3, r2, 8
 311         bmsk    r3, r3, 7
 312         brne    r3, ECR_C_MCHK_DUP_TLB, 1f
 313
 314         bl      do_tlb_overlap_fault
 315         b       ret_from_exception
 316
 317 1:
 318         ; DEAD END: can't do much, display Regs and HALT
 319         SAVE_CALLEE_SAVED_USER
 320
 321         GET_CURR_TASK_FIELD_PTR   TASK_THREAD, r10
 322         st  sp, [r10, THREAD_CALLEE_REG]
 323
 324         j  do_machine_check_fault
 325
 326 ARC_EXIT EV_MachineCheck
 327
 328 ; ---------------------------------------------
 329 ; Protection Violation Exception Handler
 330 ; ---------------------------------------------
 331
 332 ARC_ENTRY EV_TLBProtV
 333
 334         EXCEPTION_PROLOGUE
 335
 336         ;---------(3) Save some more regs-----------------
 337         ;  vineetg: Mar 6th: Random Seg Fault issue #1
 338         ;  ecr and efa were not saved in case an Intr sneaks in
 339         ;  after fake rtie
 340
 341         lr  r2, [ecr]
 342         lr  r0, [efa]   ; Faulting Data address
 343
 344         ; --------(4) Return from CPU Exception Mode ---------
 345         ;  Fake a rtie, but rtie to next label
 346         ;  That way, subsequently, do_page_fault ( ) executes in pure kernel
 347         ;  mode with further Exceptions enabled
 348
 349         FAKE_RET_FROM_EXCPN r9
 350
 351         mov   r1, sp
 352
 353         ;------ (5) Type of Protection Violation? ----------
 354         ;
 355         ; ProtV Hardware Exception is triggered for Access Faults of 2 types
 356         ;   -Access Violaton    : 00_23_(00|01|02|03)_00
 357         ;                                x  r  w  r+w
 358         ;   -Unaligned Access   : 00_23_04_00
 359         ;
 360         bbit1 r2, ECR_C_BIT_PROTV_MISALIG_DATA, 4f
 361
 362         ;========= (6a) Access Violation Processing ========
 363         bl  do_page_fault
 364         b   ret_from_exception
 365
 366         ;========== (6b) Non aligned access ============
 367 4:
 368
 369 #ifdef  CONFIG_ARC_MISALIGN_ACCESS
 370         SAVE_CALLEE_SAVED_USER
 371         mov r2, sp              ; callee_regs
 372
 373         bl  do_misaligned_access
 374
 375         ; TBD: optimize - do this only if a callee reg was involved
 376         ; either a dst of emulated LD/ST or src with address-writeback
 377         RESTORE_CALLEE_SAVED_USER
 378 #else
 379         bl  do_misaligned_error
 380 #endif
 381
 382         b   ret_from_exception
 383
 384 ARC_EXIT EV_TLBProtV
 385
 386 ; ---------------------------------------------
 387 ; Privilege Violation Exception Handler
 388 ; ---------------------------------------------
 389 ARC_ENTRY EV_PrivilegeV
 390
 391         EXCEPTION_PROLOGUE
 392
 393         lr  r0, [efa]
 394         mov r1, sp
 395
 396         FAKE_RET_FROM_EXCPN r9
 397
 398         bl  do_privilege_fault
 399         b   ret_from_exception
 400 ARC_EXIT EV_PrivilegeV
 401
 402 ; ---------------------------------------------
 403 ; Extension Instruction Exception Handler
 404 ; ---------------------------------------------
 405 ARC_ENTRY EV_Extension
 406
 407         EXCEPTION_PROLOGUE
 408
 409         lr  r0, [efa]
 410         mov r1, sp
 411
 412         FAKE_RET_FROM_EXCPN r9
 413
 414         bl  do_extension_fault
 415         b   ret_from_exception
 416 ARC_EXIT EV_Extension
 417
 418 ;######################### System Call Tracing #########################
 419
 420 tracesys:
 421         ; save EFA in case tracer wants the PC of traced task
 422         ; using ERET won't work since next-PC has already committed
 423         lr  r12, [efa]
 424         GET_CURR_TASK_FIELD_PTR   TASK_THREAD, r11
 425         st  r12, [r11, THREAD_FAULT_ADDR]       ; thread.fault_address
 426
 427         ; PRE Sys Call Ptrace hook
 428         mov r0, sp                      ; pt_regs needed
 429         bl  @syscall_trace_entry
 430
 431         ; Tracing code now returns the syscall num (orig or modif)
 432         mov r8, r0
 433
 434         ; Do the Sys Call as we normally would.
 435         ; Validate the Sys Call number
 436         cmp     r8,  NR_syscalls
 437         mov.hi  r0, -ENOSYS
 438         bhi     tracesys_exit
 439
 440         ; Restore the sys-call args. Mere invocation of the hook abv could have
 441         ; clobbered them (since they are in scratch regs). The tracer could also
 442         ; have deliberately changed the syscall args: r0-r7
 443         ld  r0, [sp, PT_r0]
 444         ld  r1, [sp, PT_r1]
 445         ld  r2, [sp, PT_r2]
 446         ld  r3, [sp, PT_r3]
 447         ld  r4, [sp, PT_r4]
 448         ld  r5, [sp, PT_r5]
 449         ld  r6, [sp, PT_r6]
 450         ld  r7, [sp, PT_r7]
 451         ld.as   r9, [sys_call_table, r8]
 452         jl      [r9]        ; Entry into Sys Call Handler
 453
 454 tracesys_exit:
 455         st  r0, [sp, PT_r0]     ; sys call return value in pt_regs
 456
 457         ;POST Sys Call Ptrace Hook
 458         bl  @syscall_trace_exit
 459         b   ret_from_exception ; NOT ret_from_system_call at is saves r0 which
 460         ; we'd done before calling post hook above
 461
 462 ;################### Break Point TRAP ##########################
 463
 464         ; ======= (5b) Trap is due to Break-Point =========
 465
 466 trap_with_param:
 467
 468         ; stop_pc info by gdb needs this info
 469         lr  r0, [efa]
 470         mov r1, sp
 471
 472         ; Now that we have read EFA, its safe to do "fake" rtie
 473         ;   and get out of CPU exception mode
 474         FAKE_RET_FROM_EXCPN r11
 475
 476         ; Save callee regs in case gdb wants to have a look
 477         ; SP will grow up by size of CALLEE Reg-File
 478         ; NOTE: clobbers r12
 479         SAVE_CALLEE_SAVED_USER
 480
 481         ; save location of saved Callee Regs @ thread_struct->pc
 482         GET_CURR_TASK_FIELD_PTR   TASK_THREAD, r10
 483         st  sp, [r10, THREAD_CALLEE_REG]
 484
 485         ; Call the trap handler
 486         bl  do_non_swi_trap
 487
 488         ; unwind stack to discard Callee saved Regs
 489         DISCARD_CALLEE_SAVED_USER
 490
 491         b   ret_from_exception
 492
 493 ;##################### Trap Handling ##############################
 494 ;
 495 ; EV_Trap caused by TRAP_S and TRAP0 instructions.
 496 ;------------------------------------------------------------------
 497 ;   (1) System Calls
 498 ;       :parameters in r0-r7.
 499 ;       :r8 has the system call number
 500 ;   (2) Break Points
 501 ;------------------------------------------------------------------
 502
 503 ARC_ENTRY EV_Trap
 504
 505         EXCEPTION_PROLOGUE
 506
 507         ;------- (4) What caused the Trap --------------
 508         lr     r12, [ecr]
 509         bmsk.f 0, r12, 7
 510         bnz    trap_with_param
 511
 512         ; ======= (5a) Trap is due to System Call ========
 513
 514         ; Before doing anything, return from CPU Exception Mode
 515         FAKE_RET_FROM_EXCPN r11
 516
 517         ; If syscall tracing ongoing, invoke pre-pos-hooks
 518         GET_CURR_THR_INFO_FLAGS   r10
 519         btst r10, TIF_SYSCALL_TRACE
 520         bnz tracesys  ; this never comes back
 521
 522         ;============ This is normal System Call case ==========
 523         ; Sys-call num shd not exceed the total system calls avail
 524         cmp     r8,  NR_syscalls
 525         mov.hi  r0, -ENOSYS
 526         bhi     ret_from_system_call
 527
 528         ; Offset into the syscall_table and call handler
 529         ld.as   r9,[sys_call_table, r8]
 530         jl      [r9]        ; Entry into Sys Call Handler
 531
 532         ; fall through to ret_from_system_call
 533 ARC_EXIT EV_Trap
 534
 535 ARC_ENTRY ret_from_system_call
 536
 537         st  r0, [sp, PT_r0]     ; sys call return value in pt_regs
 538
 539         ; fall through yet again to ret_from_exception
 540
 541 ;############# Return from Intr/Excp/Trap (Linux Specifics) ##############
 542 ;
 543 ; If ret to user mode do we need to handle signals, schedule() et al.
 544
 545 ARC_ENTRY ret_from_exception
 546
 547         ; Pre-{IRQ,Trap,Exception} K/U mode from pt_regs->status32
 548         ld  r8, [sp, PT_status32]   ; returning to User/Kernel Mode
 549
 550         bbit0  r8, STATUS_U_BIT, resume_kernel_mode
 551
 552         ; Before returning to User mode check-for-and-complete any pending work
 553         ; such as rescheduling/signal-delivery etc.
 554 resume_user_mode_begin:
 555
 556         ; Disable IRQs to ensures that chk for pending work itself is atomic
 557         ; (and we don't end up missing a NEED_RESCHED/SIGPENDING due to an
 558         ; interim IRQ).
 559         IRQ_DISABLE     r10
 560
 561         ; Fast Path return to user mode if no pending work
 562         GET_CURR_THR_INFO_FLAGS   r9
 563         and.f  0,  r9, _TIF_WORK_MASK
 564         bz     restore_regs
 565
 566         ; --- (Slow Path #1) task preemption ---
 567         bbit0  r9, TIF_NEED_RESCHED, .Lchk_pend_signals
 568         mov    blink, resume_user_mode_begin  ; tail-call to U mode ret chks
 569         b      @schedule        ; BTST+Bnz causes relo error in link
 570
 571 .Lchk_pend_signals:
 572         IRQ_ENABLE      r10
 573
 574         ; --- (Slow Path #2) pending signal  ---
 575         mov r0, sp      ; pt_regs for arg to do_signal()/do_notify_resume()
 576
 577         bbit0  r9, TIF_SIGPENDING, .Lchk_notify_resume
 578
 579         ; Normal Trap/IRQ entry only saves Scratch (caller-saved) regs
 580         ; in pt_reg since the "C" ABI (kernel code) will automatically
 581         ; save/restore callee-saved regs.
 582         ;
 583         ; However, here we need to explicitly save callee regs because
 584         ; (i)  If this signal causes coredump - full regfile needed
 585         ; (ii) If signal is SIGTRAP/SIGSTOP, task is being traced thus
 586         ;      tracer might call PEEKUSR(CALLEE reg)
 587         ;
 588         ; NOTE: SP will grow up by size of CALLEE Reg-File
 589         SAVE_CALLEE_SAVED_USER          ; clobbers r12
 590
 591         ; save location of saved Callee Regs @ thread_struct->callee
 592         GET_CURR_TASK_FIELD_PTR   TASK_THREAD, r10
 593         st  sp, [r10, THREAD_CALLEE_REG]
 594
 595         bl  @do_signal
 596
 597         ; Ideally we want to discard the Callee reg above, however if this was
 598         ; a tracing signal, tracer could have done a POKEUSR(CALLEE reg)
 599         RESTORE_CALLEE_SAVED_USER
 600
 601         b      resume_user_mode_begin   ; loop back to start of U mode ret
 602
 603         ; --- (Slow Path #3) notify_resume ---
 604 .Lchk_notify_resume:
 605         btst   r9, TIF_NOTIFY_RESUME
 606         blnz   @do_notify_resume
 607         b      resume_user_mode_begin   ; unconditionally back to U mode ret chks
 608                                         ; for single exit point from this block
 609
 610 resume_kernel_mode:
 611
 612 #ifdef CONFIG_PREEMPT
 613
 614         ; This is a must for preempt_schedule_irq()
 615         IRQ_DISABLE     r9
 616
 617         ; Can't preempt if preemption disabled
 618         GET_CURR_THR_INFO_FROM_SP   r10
 619         ld  r8, [r10, THREAD_INFO_PREEMPT_COUNT]
 620         brne  r8, 0, restore_regs
 621
 622         ; check if this task's NEED_RESCHED flag set
 623         ld  r9, [r10, THREAD_INFO_FLAGS]
 624         bbit0  r9, TIF_NEED_RESCHED, restore_regs
 625
 626         ; Invoke PREEMPTION
 627         bl      preempt_schedule_irq
 628
 629         ; preempt_schedule_irq() always returns with IRQ disabled
 630 #endif
 631
 632         ; fall through
 633
 634 ;############# Return from Intr/Excp/Trap (ARC Specifics) ##############
 635 ;
 636 ; Restore the saved sys context (common exit-path for EXCPN/IRQ/Trap)
 637 ; IRQ shd definitely not happen between now and rtie
 638 ; All 2 entry points to here already disable interrupts
 639
 640 restore_regs :
 641
 642         lr      r10, [status32]
 643
 644         ; Restore REG File. In case multiple Events outstanding,
 645         ; use the same priorty as rtie: EXCPN, L2 IRQ, L1 IRQ, None
 646         ; Note that we use realtime STATUS32 (not pt_regs->status32) to
 647         ; decide that.
 648
 649         ; if Returning from Exception
 650         bbit0  r10, STATUS_AE_BIT, not_exception
 651         RESTORE_ALL_SYS
 652         rtie
 653
 654         ; Not Exception so maybe Interrupts (Level 1 or 2)
 655
 656 not_exception:
 657
 658 #ifdef CONFIG_ARC_COMPACT_IRQ_LEVELS
 659
 660         ; Level 2 interrupt return Path - from hardware standpoint
 661         bbit0  r10, STATUS_A2_BIT, not_level2_interrupt
 662
 663         ;------------------------------------------------------------------
 664         ; However the context returning might not have taken L2 intr itself
 665         ; e.g. Task'A' user-code -> L2 intr -> schedule -> 'B' user-code ret
 666         ; Special considerations needed for the context which took L2 intr
 667
 668         ld   r9, [sp, PT_event]        ; Ensure this is L2 intr context
 669         brne r9, event_IRQ2, 149f
 670
 671         ;------------------------------------------------------------------
 672         ; if L2 IRQ interrupted a L1 ISR,  we'd disbaled preemption earlier
 673         ; so that sched doesnt move to new task, causing L1 to be delayed
 674         ; undeterministically. Now that we've achieved that, lets reset
 675         ; things to what they were, before returning from L2 context
 676         ;----------------------------------------------------------------
 677
 678         ld r9, [sp, PT_status32]       ; get statu32_l2 (saved in pt_regs)
 679         bbit0 r9, STATUS_A1_BIT, 149f  ; L1 not active when L2 IRQ, so normal
 680
 681         ; decrement thread_info->preempt_count (re-enable preemption)
 682         GET_CURR_THR_INFO_FROM_SP   r10
 683         ld      r9, [r10, THREAD_INFO_PREEMPT_COUNT]
 684
 685         ; paranoid check, given A1 was active when A2 happened, preempt count
 686         ; must not be 0 because we would have incremented it.
 687         ; If this does happen we simply HALT as it means a BUG !!!
 688         cmp     r9, 0
 689         bnz     2f
 690         flag 1
 691
 692 2:
 693         sub     r9, r9, 1
 694         st      r9, [r10, THREAD_INFO_PREEMPT_COUNT]
 695
 696 149:
 697         ;return from level 2
 698         RESTORE_ALL_INT2
 699 debug_marker_l2:
 700         rtie
 701
 702 not_level2_interrupt:
 703
 704 #endif
 705
 706         bbit0  r10, STATUS_A1_BIT, not_level1_interrupt
 707
 708         ;return from level 1
 709
 710         RESTORE_ALL_INT1
 711 debug_marker_l1:
 712         rtie
 713
 714 not_level1_interrupt:
 715
 716         ;this case is for syscalls or Exceptions (with fake rtie)
 717
 718         RESTORE_ALL_SYS
 719 debug_marker_syscall:
 720         rtie
 721
 722 ARC_EXIT ret_from_exception
 723
 724 ARC_ENTRY ret_from_fork
 725         ; when the forked child comes here from the __switch_to function
 726         ; r0 has the last task pointer.
 727         ; put last task in scheduler queue
 728         bl   @schedule_tail
 729
 730         ; If kernel thread, jump to it's entry-point
 731         ld   r9, [sp, PT_status32]
 732         brne r9, 0, 1f
 733
 734         jl.d [r14]
 735         mov  r0, r13            ; arg to payload
 736
 737 1:
 738         ; special case of kernel_thread entry point returning back due to
 739         ; kernel_execve() - pretend return from syscall to ret to userland
 740         b    ret_from_exception
 741 ARC_EXIT ret_from_fork
 742
 743 ;################### Special Sys Call Wrappers ##########################
 744
 745 ARC_ENTRY sys_clone_wrapper
 746         SAVE_CALLEE_SAVED_USER
 747         bl  @sys_clone
 748         DISCARD_CALLEE_SAVED_USER
 749
 750         GET_CURR_THR_INFO_FLAGS   r10
 751         btst r10, TIF_SYSCALL_TRACE
 752         bnz  tracesys_exit
 753
 754         b ret_from_system_call
 755 ARC_EXIT sys_clone_wrapper
 756
 757 #ifdef CONFIG_ARC_DW2_UNWIND
 758 ; Workaround for bug 94179 (STAR ):
 759 ; Despite -fasynchronous-unwind-tables, linker is not making dwarf2 unwinder
 760 ; section (.debug_frame) as loadable. So we force it here.
 761 ; This also fixes STAR 9000487933 where the prev-workaround (objcopy --setflag)
 762 ; would not work after a clean build due to kernel build system dependencies.
 763 .section .debug_frame, "wa",@progbits
 764 #endif