linux 2.6.16.38 w/ vs2.0.3-rc1

[linux-2.6.git] / arch / ppc / kernel / entry.S

diff --git a/arch/ppc/kernel/entry.S b/arch/ppc/kernel/entry.S
index a9d4553..3a28159 100644 (file)
--- a/arch/ppc/kernel/entry.S
+++ b/arch/ppc/kernel/entry.S
@@ -19,6 +19,7 @@
  *
  */
 
+#include <linux/config.h>
 #include <linux/errno.h>
 #include <linux/sys.h>
 #include <linux/threads.h>
@@ -127,48 +128,45 @@ transfer_to_handler:
        stw     r12,4(r11)
 #endif
        b       3f
-
 2:     /* if from kernel, check interrupted DOZE/NAP mode and
          * check for stack overflow
          */
-       lwz     r9,THREAD_INFO-THREAD(r12)
-       cmplw   r1,r9                   /* if r1 <= current->thread_info */
-       ble-    stack_ovf               /* then the kernel stack overflowed */
-5:
 #ifdef CONFIG_6xx
-       tophys(r9,r9)                   /* check local flags */
-       lwz     r12,TI_LOCAL_FLAGS(r9)
-       mtcrf   0x01,r12
-       bt-     31-TLF_NAPPING,4f
+       mfspr   r11,SPRN_HID0
+       mtcr    r11
+BEGIN_FTR_SECTION
+       bt-     8,power_save_6xx_restore        /* Check DOZE */
+END_FTR_SECTION_IFSET(CPU_FTR_CAN_DOZE)
+BEGIN_FTR_SECTION
+       bt-     9,power_save_6xx_restore        /* Check NAP */
+END_FTR_SECTION_IFSET(CPU_FTR_CAN_NAP)
 #endif /* CONFIG_6xx */
        .globl transfer_to_handler_cont
 transfer_to_handler_cont:
+       lwz     r11,THREAD_INFO-THREAD(r12)
+       cmplw   r1,r11                  /* if r1 <= current->thread_info */
+       ble-    stack_ovf               /* then the kernel stack overflowed */
 3:
        mflr    r9
        lwz     r11,0(r9)               /* virtual address of handler */
        lwz     r9,4(r9)                /* where to go when done */
+       FIX_SRR1(r10,r12)
        mtspr   SPRN_SRR0,r11
        mtspr   SPRN_SRR1,r10
        mtlr    r9
        SYNC
        RFI                             /* jump to handler, enable MMU */
 
-#ifdef CONFIG_6xx
-4:     rlwinm  r12,r12,0,~_TLF_NAPPING
-       stw     r12,TI_LOCAL_FLAGS(r9)
-       b       power_save_6xx_restore
-#endif
-
 /*
  * On kernel stack overflow, load up an initial stack pointer
  * and call StackOverflow(regs), which should not return.
  */
 stack_ovf:
        /* sometimes we use a statically-allocated stack, which is OK. */
-       lis     r12,_end@h
-       ori     r12,r12,_end@l
-       cmplw   r1,r12
-       ble     5b                      /* r1 <= &_end is OK */
+       lis     r11,_end@h
+       ori     r11,r11,_end@l
+       cmplw   r1,r11
+       ble     3b                      /* r1 <= &_end is OK */
        SAVE_NVGPRS(r11)
        addi    r3,r1,STACK_FRAME_OVERHEAD
        lis     r1,init_thread_union@ha
@@ -928,3 +926,55 @@ END_FTR_SECTION_IFSET(CPU_FTR_601)
        b       4b
 
        .comm   ee_restarts,4
+
+/*
+ * PROM code for specific machines follows.  Put it
+ * here so it's easy to add arch-specific sections later.
+ * -- Cort
+ */
+#ifdef CONFIG_PPC_OF
+/*
+ * On CHRP, the Run-Time Abstraction Services (RTAS) have to be
+ * called with the MMU off.
+ */
+_GLOBAL(enter_rtas)
+       stwu    r1,-INT_FRAME_SIZE(r1)
+       mflr    r0
+       stw     r0,INT_FRAME_SIZE+4(r1)
+       lis     r4,rtas_data@ha
+       lwz     r4,rtas_data@l(r4)
+       lis     r6,1f@ha        /* physical return address for rtas */
+       addi    r6,r6,1f@l
+       tophys(r6,r6)
+       tophys(r7,r1)
+       lis     r8,rtas_entry@ha
+       lwz     r8,rtas_entry@l(r8)
+       mfmsr   r9
+       stw     r9,8(r1)
+       LOAD_MSR_KERNEL(r0,MSR_KERNEL)
+       SYNC                    /* disable interrupts so SRR0/1 */
+       MTMSRD(r0)              /* don't get trashed */
+       li      r9,MSR_KERNEL & ~(MSR_IR|MSR_DR)
+       mtlr    r6
+       CLR_TOP32(r7)
+       mtspr   SPRN_SPRG2,r7
+       mtspr   SPRN_SRR0,r8
+       mtspr   SPRN_SRR1,r9
+       RFI
+1:     tophys(r9,r1)
+       lwz     r8,INT_FRAME_SIZE+4(r9) /* get return address */
+       lwz     r9,8(r9)        /* original msr value */
+       FIX_SRR1(r9,r0)
+       addi    r1,r1,INT_FRAME_SIZE
+       li      r0,0
+       mtspr   SPRN_SPRG2,r0
+       mtspr   SPRN_SRR0,r8
+       mtspr   SPRN_SRR1,r9
+       RFI                     /* return to caller */
+
+       .globl  machine_check_in_rtas
+machine_check_in_rtas:
+       twi     31,0,0
+       /* XXX load up BATs and panic */
+
+#endif /* CONFIG_PPC_OF */