1 files changed, 90 insertions, 0 deletions

diff --git a/arch/powerpc/include/asm/exception-64s.h b/arch/powerpc/include/asm/exception-64s.h
index 9258daac4964..10787d3673ac 100644
--- a/arch/powerpc/include/asm/exception-64s.h
+++ b/arch/powerpc/include/asm/exception-64s.h
@@ -48,6 +48,35 @@
 #define EX_LR           72
 #define EX_CFAR         80
 
+#ifdef CONFIG_RELOCATABLE
+#define EXCEPTION_RELON_PROLOG_PSERIES_1(label, h)                      \
+        ld      r12,PACAKBASE(r13);     /* get high part of &label */   \
+        mfspr   r11,SPRN_##h##SRR0;     /* save SRR0 */                 \
+        LOAD_HANDLER(r12,label);                                        \
+        mtlr    r12;                                                    \
+        mfspr   r12,SPRN_##h##SRR1;     /* and SRR1 */                  \
+        li      r10,MSR_RI;                                             \
+        mtmsrd  r10,1;                  /* Set RI (EE=0) */             \
+        blr;
+#else
+/* If not relocatable, we can jump directly -- and save messing with LR */
+#define EXCEPTION_RELON_PROLOG_PSERIES_1(label, h)                      \
+        mfspr   r11,SPRN_##h##SRR0;     /* save SRR0 */                 \
+        mfspr   r12,SPRN_##h##SRR1;     /* and SRR1 */                  \
+        li      r10,MSR_RI;                                             \
+        mtmsrd  r10,1;                  /* Set RI (EE=0) */             \
+        b       label;
+#endif
+
+/*
+ * As EXCEPTION_PROLOG_PSERIES(), except we've already got relocation on
+ * so no need to rfid.  Save lr in case we're CONFIG_RELOCATABLE, in which
+ * case EXCEPTION_RELON_PROLOG_PSERIES_1 will be using lr.
+ */
+#define EXCEPTION_RELON_PROLOG_PSERIES(area, label, h, extra, vec)      \
+        EXCEPTION_PROLOG_1(area, extra, vec);                           \
+        EXCEPTION_RELON_PROLOG_PSERIES_1(label, h)
+
 /*
  * We're short on space and time in the exception prolog, so we can't
  * use the normal SET_REG_IMMEDIATE macro. Normally we just need the
@@ -62,6 +91,22 @@
 #define EXC_HV  H
 #define EXC_STD
 
+#if defined(CONFIG_RELOCATABLE)
+/*
+ * If we support interrupts with relocation on AND we're a relocatable
+ * kernel, we need to use LR to get to the 2nd level handler.  So, save/restore
+ * it when required.
+ */
+#define SAVE_LR(reg, area)      mflr    reg ;   std     reg,area+EX_LR(r13)
+#define GET_LR(reg, area)                       ld      reg,area+EX_LR(r13)
+#define RESTORE_LR(reg, area)   ld      reg,area+EX_LR(r13) ; mtlr reg
+#else
+/* ...else LR is unused and in register. */
+#define SAVE_LR(reg, area)
+#define GET_LR(reg, area)       mflr    reg
+#define RESTORE_LR(reg, area)
+#endif
+
 #define __EXCEPTION_PROLOG_1(area, extra, vec)                          \
         GET_PACA(r13);                                                  \
         std     r9,area+EX_R9(r13);     /* save r9 - r12 */             \
@@ -233,6 +278,26 @@ label##_hv:						\
         EXCEPTION_PROLOG_PSERIES(PACA_EXGEN, label##_common,    \
                                  EXC_HV, KVMTEST, vec)
 
+#define STD_RELON_EXCEPTION_PSERIES(loc, vec, label)    \
+        . = loc;                                        \
+        .globl label##_relon_pSeries;                   \
+label##_relon_pSeries:                                  \
+        HMT_MEDIUM;                                     \
+        /* No guest interrupts come through here */     \
+        SET_SCRATCH0(r13);              /* save r13 */  \
+        EXCEPTION_RELON_PROLOG_PSERIES(PACA_EXGEN, label##_common, \
+                                       EXC_STD, KVMTEST_PR, vec)
+
+#define STD_RELON_EXCEPTION_HV(loc, vec, label)         \
+        . = loc;                                        \
+        .globl label##_relon_hv;                        \
+label##_relon_hv:                                       \
+        HMT_MEDIUM;                                     \
+        /* No guest interrupts come through here */     \
+        SET_SCRATCH0(r13);      /* save r13 */          \
+        EXCEPTION_RELON_PROLOG_PSERIES(PACA_EXGEN, label##_common, \
+                                       EXC_HV, KVMTEST, vec)
+
 /* This associate vector numbers with bits in paca->irq_happened */
 #define SOFTEN_VALUE_0x500      PACA_IRQ_EE
 #define SOFTEN_VALUE_0x502      PACA_IRQ_EE
@@ -258,6 +323,9 @@ label##_hv:						\
         KVMTEST(vec);                                                   \
         _SOFTEN_TEST(EXC_STD, vec)
 
+#define SOFTEN_NOTEST_PR(vec)           _SOFTEN_TEST(EXC_STD, vec)
+#define SOFTEN_NOTEST_HV(vec)           _SOFTEN_TEST(EXC_HV, vec)
+
 #define __MASKABLE_EXCEPTION_PSERIES(vec, label, h, extra)              \
         HMT_MEDIUM;                                                     \
         SET_SCRATCH0(r13);    /* save r13 */                            \
@@ -280,6 +348,28 @@ label##_hv:								\
         _MASKABLE_EXCEPTION_PSERIES(vec, label,                         \
                                     EXC_HV, SOFTEN_TEST_HV)
 
+#define __MASKABLE_RELON_EXCEPTION_PSERIES(vec, label, h, extra)        \
+        HMT_MEDIUM;                                                     \
+        SET_SCRATCH0(r13);    /* save r13 */                            \
+        __EXCEPTION_PROLOG_1(PACA_EXGEN, extra, vec);           \
+        EXCEPTION_RELON_PROLOG_PSERIES_1(label##_common, h);
+#define _MASKABLE_RELON_EXCEPTION_PSERIES(vec, label, h, extra) \
+        __MASKABLE_RELON_EXCEPTION_PSERIES(vec, label, h, extra)
+
+#define MASKABLE_RELON_EXCEPTION_PSERIES(loc, vec, label)               \
+        . = loc;                                                        \
+        .globl label##_relon_pSeries;                                   \
+label##_relon_pSeries:                                                  \
+        _MASKABLE_RELON_EXCEPTION_PSERIES(vec, label,                   \
+                                          EXC_STD, SOFTEN_NOTEST_PR)
+
+#define MASKABLE_RELON_EXCEPTION_HV(loc, vec, label)                    \
+        . = loc;                                                        \
+        .globl label##_relon_hv;                                        \
+label##_relon_hv:                                                       \
+        _MASKABLE_RELON_EXCEPTION_PSERIES(vec, label,                   \
+                                          EXC_HV, SOFTEN_NOTEST_HV)
+
 /*
  * Our exception common code can be passed various "additions"
  * to specify the behaviour of interrupts, whether to kick the