3 * Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org)
4 * Rewritten by Cort Dougan (cort@cs.nmt.edu) for PReP
5 * Copyright (C) 1996 Cort Dougan <cort@cs.nmt.edu>
6 * Adapted for Power Macintosh by Paul Mackerras.
7 * Low-level exception handlers and MMU support
8 * rewritten by Paul Mackerras.
9 * Copyright (C) 1996 Paul Mackerras.
10 * MPC8xx modifications Copyright (C) 1997 Dan Malek (dmalek@jlc.net).
12 * This file contains the system call entry code, context switch
13 * code, and exception/interrupt return code for PowerPC.
15 * This program is free software; you can redistribute it and/or
16 * modify it under the terms of the GNU General Public License
17 * as published by the Free Software Foundation; either version
18 * 2 of the License, or (at your option) any later version.
21 #include <linux/errno.h>
22 #include <asm/unistd.h>
23 #include <asm/processor.h>
26 #include <asm/thread_info.h>
27 #include <asm/ppc_asm.h>
28 #include <asm/asm-offsets.h>
29 #include <asm/cputable.h>
30 #include <asm/firmware.h>
32 #include <asm/ptrace.h>
33 #include <asm/irqflags.h>
34 #include <asm/ftrace.h>
35 #include <asm/hw_irq.h>
36 #include <asm/context_tracking.h>
44 .tc sys_call_table[TC],sys_call_table
46 /* This value is used to mark exception frames on the stack. */
48 .tc ID_EXC_MARKER[TC],STACK_FRAME_REGS_MARKER
53 .globl system_call_common
55 #ifdef CONFIG_PPC_TRANSACTIONAL_MEM
57 extrdi. r10, r12, 1, (63-MSR_TS_T_LG) /* transaction active? */
59 END_FTR_SECTION_IFSET(CPU_FTR_TM)
63 addi r1,r1,-INT_FRAME_SIZE
71 beq 2f /* if from kernel mode */
72 ACCOUNT_CPU_USER_ENTRY(r10, r11)
91 * This clears CR0.SO (bit 28), which is the error indication on
92 * return from this system call.
94 rldimi r2,r11,28,(63-28)
101 addi r9,r1,STACK_FRAME_OVERHEAD
102 ld r11,exception_marker@toc(r2)
103 std r11,-16(r9) /* "regshere" marker */
104 #if defined(CONFIG_VIRT_CPU_ACCOUNTING_NATIVE) && defined(CONFIG_PPC_SPLPAR)
107 /* if from user, see if there are any DTL entries to process */
108 ld r10,PACALPPACAPTR(r13) /* get ptr to VPA */
109 ld r11,PACA_DTL_RIDX(r13) /* get log read index */
110 addi r10,r10,LPPACA_DTLIDX
111 LDX_BE r10,0,r10 /* get log write index */
114 bl accumulate_stolen_time
118 addi r9,r1,STACK_FRAME_OVERHEAD
120 END_FW_FTR_SECTION_IFSET(FW_FEATURE_SPLPAR)
121 #endif /* CONFIG_VIRT_CPU_ACCOUNTING_NATIVE && CONFIG_PPC_SPLPAR */
124 * A syscall should always be called with interrupts enabled
125 * so we just unconditionally hard-enable here. When some kind
126 * of irq tracing is used, we additionally check that condition
129 #if defined(CONFIG_TRACE_IRQFLAGS) && defined(CONFIG_BUG)
130 lbz r10,PACASOFTIRQEN(r13)
133 EMIT_BUG_ENTRY 1b,__FILE__,__LINE__,BUGFLAG_WARNING
136 #ifdef CONFIG_PPC_BOOK3E
142 #endif /* CONFIG_PPC_BOOK3E */
144 /* We do need to set SOFTE in the stack frame or the return
145 * from interrupt will be painful
150 CURRENT_THREAD_INFO(r11, r1)
152 andi. r11,r10,_TIF_SYSCALL_DOTRACE
154 .Lsyscall_dotrace_cont:
155 cmpldi 0,r0,NR_syscalls
158 system_call: /* label this so stack traces look sane */
160 * Need to vector to 32 Bit or default sys_call_table here,
161 * based on caller's run-mode / personality.
163 ld r11,SYS_CALL_TABLE@toc(2)
164 andi. r10,r10,_TIF_32BIT
166 addi r11,r11,8 /* use 32-bit syscall entries */
175 ldx r12,r11,r0 /* Fetch system call handler [ptr] */
177 bctrl /* Call handler */
181 CURRENT_THREAD_INFO(r12, r1)
184 #ifdef CONFIG_PPC_BOOK3S
185 /* No MSR:RI on BookE */
190 * Disable interrupts so current_thread_info()->flags can't change,
191 * and so that we don't get interrupted after loading SRR0/1.
193 #ifdef CONFIG_PPC_BOOK3E
198 * For performance reasons we clear RI the same time that we
199 * clear EE. We only need to clear RI just before we restore r13
200 * below, but batching it with EE saves us one expensive mtmsrd call.
201 * We have to be careful to restore RI if we branch anywhere from
202 * here (eg syscall_exit_work).
207 #endif /* CONFIG_PPC_BOOK3E */
211 andi. r0,r9,(_TIF_SYSCALL_DOTRACE|_TIF_SINGLESTEP|_TIF_USER_WORK_MASK|_TIF_PERSYSCALL_MASK)
212 bne- syscall_exit_work
216 .Lsyscall_error_cont:
219 stdcx. r0,0,r1 /* to clear the reservation */
220 END_FTR_SECTION_IFCLR(CPU_FTR_STCX_CHECKS_ADDRESS)
225 ACCOUNT_CPU_USER_EXIT(r11, r12)
226 HMT_MEDIUM_LOW_HAS_PPR
227 ld r13,GPR13(r1) /* only restore r13 if returning to usermode */
235 b . /* prevent speculative execution */
238 oris r5,r5,0x1000 /* Set SO bit in CR */
241 b .Lsyscall_error_cont
243 /* Traced system call support */
246 addi r3,r1,STACK_FRAME_OVERHEAD
247 bl do_syscall_trace_enter
249 * Restore argument registers possibly just changed.
250 * We use the return value of do_syscall_trace_enter
251 * for the call number to look up in the table (r0).
260 addi r9,r1,STACK_FRAME_OVERHEAD
261 CURRENT_THREAD_INFO(r10, r1)
263 b .Lsyscall_dotrace_cont
270 #ifdef CONFIG_PPC_BOOK3S
271 mtmsrd r10,1 /* Restore RI */
273 /* If TIF_RESTOREALL is set, don't scribble on either r3 or ccr.
274 If TIF_NOERROR is set, just save r3 as it is. */
276 andi. r0,r9,_TIF_RESTOREALL
280 0: cmpld r3,r11 /* r10 is -LAST_ERRNO */
282 andi. r0,r9,_TIF_NOERROR
286 oris r5,r5,0x1000 /* Set SO bit in CR */
289 2: andi. r0,r9,(_TIF_PERSYSCALL_MASK)
292 /* Clear per-syscall TIF flags if any are set. */
294 li r11,_TIF_PERSYSCALL_MASK
295 addi r12,r12,TI_FLAGS
300 subi r12,r12,TI_FLAGS
302 4: /* Anything else left to do? */
303 SET_DEFAULT_THREAD_PPR(r3, r10) /* Set thread.ppr = 3 */
304 andi. r0,r9,(_TIF_SYSCALL_DOTRACE|_TIF_SINGLESTEP)
305 beq ret_from_except_lite
307 /* Re-enable interrupts */
308 #ifdef CONFIG_PPC_BOOK3E
314 #endif /* CONFIG_PPC_BOOK3E */
317 addi r3,r1,STACK_FRAME_OVERHEAD
318 bl do_syscall_trace_leave
321 #ifdef CONFIG_PPC_TRANSACTIONAL_MEM
323 /* Firstly we need to enable TM in the kernel */
326 rldimi r10, r13, MSR_TM_LG, 63-MSR_TM_LG
329 /* tabort, this dooms the transaction, nothing else */
330 li r13, (TM_CAUSE_SYSCALL|TM_CAUSE_PERSISTENT)
334 * Return directly to userspace. We have corrupted user register state,
335 * but userspace will never see that register state. Execution will
336 * resume after the tbegin of the aborted transaction with the
337 * checkpointed register state.
346 b . /* prevent speculative execution */
349 /* Save non-volatile GPRs, if not already saved. */
361 * The sigsuspend and rt_sigsuspend system calls can call do_signal
362 * and thus put the process into the stopped state where we might
363 * want to examine its user state with ptrace. Therefore we need
364 * to save all the nonvolatile registers (r14 - r31) before calling
365 * the C code. Similarly, fork, vfork and clone need the full
366 * register state on the stack so that it can be copied to the child.
384 _GLOBAL(ppc32_swapcontext)
386 bl compat_sys_swapcontext
389 _GLOBAL(ppc64_swapcontext)
394 _GLOBAL(ppc_switch_endian)
399 _GLOBAL(ret_from_fork)
405 _GLOBAL(ret_from_kernel_thread)
410 #if defined(_CALL_ELF) && _CALL_ELF == 2
418 * This routine switches between two different tasks. The process
419 * state of one is saved on its kernel stack. Then the state
420 * of the other is restored from its kernel stack. The memory
421 * management hardware is updated to the second process's state.
422 * Finally, we can return to the second process, via ret_from_except.
423 * On entry, r3 points to the THREAD for the current task, r4
424 * points to the THREAD for the new task.
426 * Note: there are two ways to get to the "going out" portion
427 * of this code; either by coming in via the entry (_switch)
428 * or via "fork" which must set up an environment equivalent
429 * to the "_switch" path. If you change this you'll have to change
430 * the fork code also.
432 * The code which creates the new task context is in 'copy_thread'
433 * in arch/powerpc/kernel/process.c
439 stdu r1,-SWITCH_FRAME_SIZE(r1)
440 /* r3-r13 are caller saved -- Cort */
443 mflr r20 /* Return to switch caller */
448 oris r0,r0,MSR_VSX@h /* Disable VSX */
449 END_FTR_SECTION_IFSET(CPU_FTR_VSX)
450 #endif /* CONFIG_VSX */
451 #ifdef CONFIG_ALTIVEC
453 oris r0,r0,MSR_VEC@h /* Disable altivec */
454 mfspr r24,SPRN_VRSAVE /* save vrsave register value */
455 std r24,THREAD_VRSAVE(r3)
456 END_FTR_SECTION_IFSET(CPU_FTR_ALTIVEC)
457 #endif /* CONFIG_ALTIVEC */
466 std r1,KSP(r3) /* Set old stack pointer */
468 #ifdef CONFIG_PPC_BOOK3S_64
470 /* Event based branch registers */
472 std r0, THREAD_BESCR(r3)
474 std r0, THREAD_EBBHR(r3)
476 std r0, THREAD_EBBRR(r3)
477 END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S)
481 /* We need a sync somewhere here to make sure that if the
482 * previous task gets rescheduled on another CPU, it sees all
483 * stores it has performed on this one.
486 #endif /* CONFIG_SMP */
489 * If we optimise away the clear of the reservation in system
490 * calls because we know the CPU tracks the address of the
491 * reservation, then we need to clear it here to cover the
492 * case that the kernel context switch path has no larx
497 END_FTR_SECTION_IFSET(CPU_FTR_STCX_CHECKS_ADDRESS)
499 #ifdef CONFIG_PPC_BOOK3S
500 /* Cancel all explict user streams as they will have no use after context
501 * switch and will stop the HW from creating streams itself
503 DCBT_STOP_ALL_STREAM_IDS(r6)
506 addi r6,r4,-THREAD /* Convert THREAD to 'current' */
507 std r6,PACACURRENT(r13) /* Set new 'current' */
509 ld r8,KSP(r4) /* new stack pointer */
510 #ifdef CONFIG_PPC_BOOK3S
512 clrrdi r6,r8,28 /* get its ESID */
513 clrrdi r9,r1,28 /* get current sp ESID */
515 clrrdi r6,r8,40 /* get its 1T ESID */
516 clrrdi r9,r1,40 /* get current sp 1T ESID */
517 ALT_MMU_FTR_SECTION_END_IFCLR(MMU_FTR_1T_SEGMENT)
518 clrldi. r0,r6,2 /* is new ESID c00000000? */
519 cmpd cr1,r6,r9 /* or is new ESID the same as current ESID? */
521 beq 2f /* if yes, don't slbie it */
523 /* Bolt in the new stack SLB entry */
524 ld r7,KSP_VSID(r4) /* Get new stack's VSID */
525 oris r0,r6,(SLB_ESID_V)@h
526 ori r0,r0,(SLB_NUM_BOLTED-1)@l
528 li r9,MMU_SEGSIZE_1T /* insert B field */
529 oris r6,r6,(MMU_SEGSIZE_1T << SLBIE_SSIZE_SHIFT)@h
530 rldimi r7,r9,SLB_VSID_SSIZE_SHIFT,0
531 END_MMU_FTR_SECTION_IFSET(MMU_FTR_1T_SEGMENT)
533 /* Update the last bolted SLB. No write barriers are needed
534 * here, provided we only update the current CPU's SLB shadow
537 ld r9,PACA_SLBSHADOWPTR(r13)
539 std r12,SLBSHADOW_STACKESID(r9) /* Clear ESID */
540 li r12,SLBSHADOW_STACKVSID
541 STDX_BE r7,r12,r9 /* Save VSID */
542 li r12,SLBSHADOW_STACKESID
543 STDX_BE r0,r12,r9 /* Save ESID */
545 /* No need to check for MMU_FTR_NO_SLBIE_B here, since when
546 * we have 1TB segments, the only CPUs known to have the errata
547 * only support less than 1TB of system memory and we'll never
548 * actually hit this code path.
552 slbie r6 /* Workaround POWER5 < DD2.1 issue */
556 #endif /* !CONFIG_PPC_BOOK3S */
558 CURRENT_THREAD_INFO(r7, r8) /* base of new stack */
559 /* Note: this uses SWITCH_FRAME_SIZE rather than INT_FRAME_SIZE
560 because we don't need to leave the 288-byte ABI gap at the
561 top of the kernel stack. */
562 addi r7,r7,THREAD_SIZE-SWITCH_FRAME_SIZE
564 mr r1,r8 /* start using new stack pointer */
565 std r7,PACAKSAVE(r13)
567 #ifdef CONFIG_PPC_BOOK3S_64
569 /* Event based branch registers */
570 ld r0, THREAD_BESCR(r4)
572 ld r0, THREAD_EBBHR(r4)
574 ld r0, THREAD_EBBRR(r4)
579 END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S)
582 #ifdef CONFIG_ALTIVEC
584 ld r0,THREAD_VRSAVE(r4)
585 mtspr SPRN_VRSAVE,r0 /* if G4, restore VRSAVE reg */
586 END_FTR_SECTION_IFSET(CPU_FTR_ALTIVEC)
587 #endif /* CONFIG_ALTIVEC */
590 lwz r6,THREAD_DSCR_INHERIT(r4)
591 ld r0,THREAD_DSCR(r4)
594 ld r0,PACA_DSCR_DEFAULT(r13)
596 BEGIN_FTR_SECTION_NESTED(70)
598 rldimi r8, r6, FSCR_DSCR_LG, (63 - FSCR_DSCR_LG)
600 END_FTR_SECTION_NESTED(CPU_FTR_ARCH_207S, CPU_FTR_ARCH_207S, 70)
605 END_FTR_SECTION_IFSET(CPU_FTR_DSCR)
611 /* r3-r13 are destroyed -- Cort */
615 /* convert old thread to its task_struct for return value */
617 ld r7,_NIP(r1) /* Return to _switch caller in new task */
619 addi r1,r1,SWITCH_FRAME_SIZE
623 _GLOBAL(ret_from_except)
626 bne ret_from_except_lite
629 _GLOBAL(ret_from_except_lite)
631 * Disable interrupts so that current_thread_info()->flags
632 * can't change between when we test it and when we return
633 * from the interrupt.
635 #ifdef CONFIG_PPC_BOOK3E
638 ld r10,PACAKMSR(r13) /* Get kernel MSR without EE */
639 mtmsrd r10,1 /* Update machine state */
640 #endif /* CONFIG_PPC_BOOK3E */
642 CURRENT_THREAD_INFO(r9, r1)
644 #ifdef CONFIG_PPC_BOOK3E
645 ld r10,PACACURRENT(r13)
646 #endif /* CONFIG_PPC_BOOK3E */
650 #ifdef CONFIG_PPC_BOOK3E
651 lwz r3,(THREAD+THREAD_DBCR0)(r10)
652 #endif /* CONFIG_PPC_BOOK3E */
654 /* Check current_thread_info()->flags */
655 andi. r0,r4,_TIF_USER_WORK_MASK
656 #ifdef CONFIG_PPC_BOOK3E
659 * Check to see if the dbcr0 register is set up to debug.
660 * Use the internal debug mode bit to do this.
662 andis. r0,r3,DBCR0_IDM@h
665 rlwinm r0,r0,0,~MSR_DE /* Clear MSR.DE */
674 1: andi. r0,r4,_TIF_NEED_RESCHED
676 bl restore_interrupts
678 b ret_from_except_lite
680 #ifdef CONFIG_PPC_TRANSACTIONAL_MEM
681 andi. r0,r4,_TIF_USER_WORK_MASK & ~_TIF_RESTORE_TM
682 bne 3f /* only restore TM if nothing else to do */
683 addi r3,r1,STACK_FRAME_OVERHEAD
690 * Use a non volatile GPR to save and restore our thread_info flags
691 * across the call to restore_interrupts.
694 bl restore_interrupts
696 addi r3,r1,STACK_FRAME_OVERHEAD
701 /* check current_thread_info, _TIF_EMULATE_STACK_STORE */
702 andis. r8,r4,_TIF_EMULATE_STACK_STORE@h
705 addi r8,r1,INT_FRAME_SIZE /* Get the kprobed function entry */
708 subi r3,r3,INT_FRAME_SIZE /* dst: Allocate a trampoline exception frame */
709 mr r4,r1 /* src: current exception frame */
710 mr r1,r3 /* Reroute the trampoline frame to r1 */
712 /* Copy from the original to the trampoline. */
713 li r5,INT_FRAME_SIZE/8 /* size: INT_FRAME_SIZE */
714 li r6,0 /* start offset: 0 */
721 /* Do real store operation to complete stwu */
725 /* Clear _TIF_EMULATE_STACK_STORE flag */
726 lis r11,_TIF_EMULATE_STACK_STORE@h
734 #ifdef CONFIG_PREEMPT
735 /* Check if we need to preempt */
736 andi. r0,r4,_TIF_NEED_RESCHED
738 /* Check that preempt_count() == 0 and interrupts are enabled */
739 lwz r8,TI_PREEMPT(r9)
743 crandc eq,cr1*4+eq,eq
747 * Here we are preempting the current task. We want to make
748 * sure we are soft-disabled first and reconcile irq state.
750 RECONCILE_IRQ_STATE(r3,r4)
751 1: bl preempt_schedule_irq
753 /* Re-test flags and eventually loop */
754 CURRENT_THREAD_INFO(r9, r1)
756 andi. r0,r4,_TIF_NEED_RESCHED
760 * arch_local_irq_restore() from preempt_schedule_irq above may
761 * enable hard interrupt but we really should disable interrupts
762 * when we return from the interrupt, and so that we don't get
763 * interrupted after loading SRR0/1.
765 #ifdef CONFIG_PPC_BOOK3E
768 ld r10,PACAKMSR(r13) /* Get kernel MSR without EE */
769 mtmsrd r10,1 /* Update machine state */
770 #endif /* CONFIG_PPC_BOOK3E */
771 #endif /* CONFIG_PREEMPT */
773 .globl fast_exc_return_irq
777 * This is the main kernel exit path. First we check if we
778 * are about to re-enable interrupts
781 lbz r6,PACASOFTIRQEN(r13)
785 /* We are enabling, were we already enabled ? Yes, just return */
790 * We are about to soft-enable interrupts (we are hard disabled
791 * at this point). We check if there's anything that needs to
794 lbz r0,PACAIRQHAPPENED(r13)
796 bne- restore_check_irq_replay
799 * Get here when nothing happened while soft-disabled, just
800 * soft-enable and move-on. We will hard-enable as a side
806 stb r0,PACASOFTIRQEN(r13);
809 * Final return path. BookE is handled in a different file
812 #ifdef CONFIG_PPC_BOOK3E
813 b exception_return_book3e
816 * Clear the reservation. If we know the CPU tracks the address of
817 * the reservation then we can potentially save some cycles and use
818 * a larx. On POWER6 and POWER7 this is significantly faster.
821 stdcx. r0,0,r1 /* to clear the reservation */
824 ALT_FTR_SECTION_END_IFCLR(CPU_FTR_STCX_CHECKS_ADDRESS)
827 * Some code path such as load_up_fpu or altivec return directly
828 * here. They run entirely hard disabled and do not alter the
829 * interrupt state. They also don't use lwarx/stwcx. and thus
830 * are known not to leave dangling reservations.
832 .globl fast_exception_return
833 fast_exception_return:
847 /* Load PPR from thread struct before we clear MSR:RI */
849 ld r2,PACACURRENT(r13)
850 ld r2,TASKTHREADPPR(r2)
851 END_FTR_SECTION_IFSET(CPU_FTR_HAS_PPR)
854 * Clear RI before restoring r13. If we are returning to
855 * userspace and we take an exception after restoring r13,
856 * we end up corrupting the userspace r13 value.
858 ld r4,PACAKMSR(r13) /* Get kernel MSR without EE */
859 andc r4,r4,r0 /* r0 contains MSR_RI here */
862 #ifdef CONFIG_PPC_TRANSACTIONAL_MEM
864 std r3, PACATMSCRATCH(r13) /* Stash returned-to MSR */
867 * r13 is our per cpu area, only restore it if we are returning to
868 * userspace the value stored in the stack frame may belong to
874 mtspr SPRN_PPR,r2 /* Restore PPR */
875 END_FTR_SECTION_IFSET(CPU_FTR_HAS_PPR)
876 ACCOUNT_CPU_USER_EXIT(r2, r4)
893 b . /* prevent speculative execution */
895 #endif /* CONFIG_PPC_BOOK3E */
898 * We are returning to a context with interrupts soft disabled.
900 * However, we may also about to hard enable, so we need to
901 * make sure that in this case, we also clear PACA_IRQ_HARD_DIS
902 * or that bit can get out of sync and bad things will happen
906 lbz r7,PACAIRQHAPPENED(r13)
909 rlwinm r7,r7,0,~PACA_IRQ_HARD_DIS
910 stb r7,PACAIRQHAPPENED(r13)
912 stb r0,PACASOFTIRQEN(r13);
917 * Something did happen, check if a re-emit is needed
918 * (this also clears paca->irq_happened)
920 restore_check_irq_replay:
921 /* XXX: We could implement a fast path here where we check
922 * for irq_happened being just 0x01, in which case we can
923 * clear it and return. That means that we would potentially
924 * miss a decrementer having wrapped all the way around.
926 * Still, this might be useful for things like hash_page
928 bl __check_irq_replay
930 beq restore_no_replay
933 * We need to re-emit an interrupt. We do so by re-using our
934 * existing exception frame. We first change the trap value,
935 * but we need to ensure we preserve the low nibble of it
943 * Then find the right handler and call it. Interrupts are
944 * still soft-disabled and we keep them that way.
948 addi r3,r1,STACK_FRAME_OVERHEAD;
951 1: cmpwi cr0,r3,0xe60
953 addi r3,r1,STACK_FRAME_OVERHEAD;
954 bl handle_hmi_exception
956 1: cmpwi cr0,r3,0x900
958 addi r3,r1,STACK_FRAME_OVERHEAD;
961 #ifdef CONFIG_PPC_DOORBELL
963 #ifdef CONFIG_PPC_BOOK3E
970 ALT_FTR_SECTION_END_IFSET(CPU_FTR_HVMODE)
971 #endif /* CONFIG_PPC_BOOK3E */
973 addi r3,r1,STACK_FRAME_OVERHEAD;
974 bl doorbell_exception
976 #endif /* CONFIG_PPC_DOORBELL */
977 1: b ret_from_except /* What else to do here ? */
980 addi r3,r1,STACK_FRAME_OVERHEAD
981 bl unrecoverable_exception
984 #ifdef CONFIG_PPC_RTAS
986 * On CHRP, the Run-Time Abstraction Services (RTAS) have to be
987 * called with the MMU off.
989 * In addition, we need to be in 32b mode, at least for now.
991 * Note: r3 is an input parameter to rtas, so don't trash it...
996 stdu r1,-RTAS_FRAME_SIZE(r1) /* Save SP and create stack space. */
998 /* Because RTAS is running in 32b mode, it clobbers the high order half
999 * of all registers that it saves. We therefore save those registers
1000 * RTAS might touch to the stack. (r0, r3-r13 are caller saved)
1002 SAVE_GPR(2, r1) /* Save the TOC */
1003 SAVE_GPR(13, r1) /* Save paca */
1004 SAVE_8GPRS(14, r1) /* Save the non-volatiles */
1005 SAVE_10GPRS(22, r1) /* ditto */
1018 /* Temporary workaround to clear CR until RTAS can be modified to
1025 /* There is no way it is acceptable to get here with interrupts enabled,
1026 * check it with the asm equivalent of WARN_ON
1028 lbz r0,PACASOFTIRQEN(r13)
1030 EMIT_BUG_ENTRY 1b,__FILE__,__LINE__,BUGFLAG_WARNING
1033 /* Hard-disable interrupts */
1039 /* Unfortunately, the stack pointer and the MSR are also clobbered,
1040 * so they are saved in the PACA which allows us to restore
1041 * our original state after RTAS returns.
1044 std r6,PACASAVEDMSR(r13)
1046 /* Setup our real return addr */
1047 LOAD_REG_ADDR(r4,rtas_return_loc)
1048 clrldi r4,r4,2 /* convert to realmode address */
1052 ori r0,r0,MSR_EE|MSR_SE|MSR_BE|MSR_RI
1056 rldicr r9,r9,MSR_SF_LG,(63-MSR_SF_LG)
1057 ori r9,r9,MSR_IR|MSR_DR|MSR_FE0|MSR_FE1|MSR_FP|MSR_RI|MSR_LE
1059 sync /* disable interrupts so SRR0/1 */
1060 mtmsrd r0 /* don't get trashed */
1062 LOAD_REG_ADDR(r4, rtas)
1063 ld r5,RTASENTRY(r4) /* get the rtas->entry value */
1064 ld r4,RTASBASE(r4) /* get the rtas->base value */
1069 b . /* prevent speculative execution */
1074 /* relocation is off at this point */
1076 clrldi r4,r4,2 /* convert to realmode address */
1080 ld r3,(1f-0b)(r3) /* get &rtas_restore_regs */
1088 ld r1,PACAR1(r4) /* Restore our SP */
1089 ld r4,PACASAVEDMSR(r4) /* Restore our MSR */
1094 b . /* prevent speculative execution */
1097 1: .llong rtas_restore_regs
1100 /* relocation is on at this point */
1101 REST_GPR(2, r1) /* Restore the TOC */
1102 REST_GPR(13, r1) /* Restore paca */
1103 REST_8GPRS(14, r1) /* Restore the non-volatiles */
1104 REST_10GPRS(22, r1) /* ditto */
1119 addi r1,r1,RTAS_FRAME_SIZE /* Unstack our frame */
1120 ld r0,16(r1) /* get return address */
1123 blr /* return to caller */
1125 #endif /* CONFIG_PPC_RTAS */
1130 stdu r1,-PROM_FRAME_SIZE(r1) /* Save SP and create stack space */
1132 /* Because PROM is running in 32b mode, it clobbers the high order half
1133 * of all registers that it saves. We therefore save those registers
1134 * PROM might touch to the stack. (r0, r3-r13 are caller saved)
1145 /* Put PROM address in SRR0 */
1148 /* Setup our trampoline return addr in LR */
1151 addi r4,r4,(1f - 0b)
1154 /* Prepare a 32-bit mode big endian MSR
1156 #ifdef CONFIG_PPC_BOOK3E
1157 rlwinm r11,r11,0,1,31
1160 #else /* CONFIG_PPC_BOOK3E */
1161 LOAD_REG_IMMEDIATE(r12, MSR_SF | MSR_ISF | MSR_LE)
1165 #endif /* CONFIG_PPC_BOOK3E */
1167 1: /* Return from OF */
1170 /* Just make sure that r1 top 32 bits didn't get
1175 /* Restore the MSR (back to 64 bits) */
1180 /* Restore other registers */
1188 addi r1,r1,PROM_FRAME_SIZE
1193 #ifdef CONFIG_FUNCTION_TRACER
1194 #ifdef CONFIG_DYNAMIC_FTRACE
1199 _GLOBAL_TOC(ftrace_caller)
1200 /* Taken from output of objdump from lib64/glibc */
1206 subi r3, r3, MCOUNT_INSN_SIZE
1211 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
1212 .globl ftrace_graph_call
1215 _GLOBAL(ftrace_graph_stub)
1220 _GLOBAL(ftrace_stub)
1223 _GLOBAL_TOC(_mcount)
1224 /* Taken from output of objdump from lib64/glibc */
1231 subi r3, r3, MCOUNT_INSN_SIZE
1232 LOAD_REG_ADDR(r5,ftrace_trace_function)
1240 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
1241 b ftrace_graph_caller
1246 _GLOBAL(ftrace_stub)
1249 #endif /* CONFIG_DYNAMIC_FTRACE */
1251 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
1252 _GLOBAL(ftrace_graph_caller)
1253 /* load r4 with local address */
1255 subi r4, r4, MCOUNT_INSN_SIZE
1257 /* Grab the LR out of the caller stack frame */
1261 bl prepare_ftrace_return
1265 * prepare_ftrace_return gives us the address we divert to.
1266 * Change the LR in the callers stack frame to this.
1276 _GLOBAL(return_to_handler)
1277 /* need to save return values */
1287 * We might be called from a module.
1288 * Switch to our TOC to run inside the core kernel.
1292 bl ftrace_return_to_handler
1295 /* return value has real return address */
1304 /* Jump back to real return address */
1306 #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
1307 #endif /* CONFIG_FUNCTION_TRACER */