To support addition of "bitmask" to MASKABLE_* macros,
factor out the EXCPETION_PROLOG_1 macro.

Currently soft_enabled is used as the flag to determine
the interrupt state. Patch extends the soft_enabled
to be used as a mask instead of a flag.

Make it explicit the interrupt masking supported
by a gievn interrupt handler. Patch correspondingly
extends the MASKABLE_* macros with an addition's parameter.
"bitmask" parameter is passed to SOFTEN_TEST macro to decide
on masking the interrupt.

Reviewed-by: Nicholas Piggin <npig...@gmail.com>
Signed-off-by: Madhavan Srinivasan <ma...@linux.vnet.ibm.com>
---
 arch/powerpc/include/asm/exception-64s.h | 90 ++++++++++++++++++++------------
 arch/powerpc/include/asm/irqflags.h      |  4 +-
 arch/powerpc/kernel/entry_64.S           |  4 +-
 arch/powerpc/kernel/exceptions-64e.S     |  6 +--
 arch/powerpc/kernel/exceptions-64s.S     | 36 ++++++++-----
 5 files changed, 86 insertions(+), 54 deletions(-)

diff --git a/arch/powerpc/include/asm/exception-64s.h 
b/arch/powerpc/include/asm/exception-64s.h
index 75e262466b85..c8ce70bea184 100644
--- a/arch/powerpc/include/asm/exception-64s.h
+++ b/arch/powerpc/include/asm/exception-64s.h
@@ -161,18 +161,40 @@ END_FTR_SECTION_NESTED(ftr,ftr,943)
        std     r10,area+EX_R10(r13);   /* save r10 - r12 */            \
        OPT_GET_SPR(r10, SPRN_CFAR, CPU_FTR_CFAR)
 
-#define __EXCEPTION_PROLOG_1(area, extra, vec)                         \
+#define __EXCEPTION_PROLOG_1_PRE(area)                                 \
        OPT_SAVE_REG_TO_PACA(area+EX_PPR, r9, CPU_FTR_HAS_PPR);         \
        OPT_SAVE_REG_TO_PACA(area+EX_CFAR, r10, CPU_FTR_CFAR);          \
        SAVE_CTR(r10, area);                                            \
-       mfcr    r9;                                                     \
-       extra(vec);                                                     \
+       mfcr    r9;
+
+#define __EXCEPTION_PROLOG_1_POST(area)                                        
\
        std     r11,area+EX_R11(r13);                                   \
        std     r12,area+EX_R12(r13);                                   \
        GET_SCRATCH0(r10);                                              \
        std     r10,area+EX_R13(r13)
+
+/*
+ * This version of the EXCEPTION_PROLOG_1 will carry
+ * addition parameter called "bitmask" to support
+ * checking of the interrupt maskable level in the SOFTEN_TEST.
+ * Intended to be used in MASKABLE_EXCPETION_* macros.
+ */
+#define MASKABLE_EXCEPTION_PROLOG_1(area, extra, vec, bitmask)                 
\
+       __EXCEPTION_PROLOG_1_PRE(area);                                 \
+       extra(vec, bitmask);                                            \
+       __EXCEPTION_PROLOG_1_POST(area);
+
+/*
+ * This version of the EXCEPTION_PROLOG_1 is intended
+ * to be used in STD_EXCEPTION* macros
+ */
+#define _EXCEPTION_PROLOG_1(area, extra, vec)                          \
+       __EXCEPTION_PROLOG_1_PRE(area);                                 \
+       extra(vec);                                                     \
+       __EXCEPTION_PROLOG_1_POST(area);
+
 #define EXCEPTION_PROLOG_1(area, extra, vec)                           \
-       __EXCEPTION_PROLOG_1(area, extra, vec)
+       _EXCEPTION_PROLOG_1(area, extra, vec)
 
 #define __EXCEPTION_PROLOG_PSERIES_1(label, h)                         \
        ld      r12,PACAKBASE(r13);     /* get high part of &label */   \
@@ -406,79 +428,79 @@ label##_relon_hv:                                         
\
 #define SOFTEN_VALUE_0xea0     PACA_IRQ_EE
 #define SOFTEN_VALUE_0xea2     PACA_IRQ_EE
 
-#define __SOFTEN_TEST(h, vec)                                          \
+#define __SOFTEN_TEST(h, vec, bitmask)                                 \
        lbz     r10,PACASOFTIRQEN(r13);                                 \
-       cmpwi   r10,IRQ_DISABLE_MASK_LINUX;                                     
                \
+       andi.   r10,r10,bitmask;                                        \
        li      r10,SOFTEN_VALUE_##vec;                                 \
-       beq     masked_##h##interrupt
-#define _SOFTEN_TEST(h, vec)   __SOFTEN_TEST(h, vec)
+       bne     masked_##h##interrupt
+#define _SOFTEN_TEST(h, vec, bitmask)  __SOFTEN_TEST(h, vec, bitmask)
 
-#define SOFTEN_TEST_PR(vec)                                            \
+#define SOFTEN_TEST_PR(vec, bitmask)                                   \
        KVMTEST(vec);                                                   \
-       _SOFTEN_TEST(EXC_STD, vec)
+       _SOFTEN_TEST(EXC_STD, vec, bitmask)
 
-#define SOFTEN_TEST_HV(vec)                                            \
+#define SOFTEN_TEST_HV(vec, bitmask)                                   \
        KVMTEST(vec);                                                   \
-       _SOFTEN_TEST(EXC_HV, vec)
+       _SOFTEN_TEST(EXC_HV, vec, bitmask)
 
-#define SOFTEN_NOTEST_PR(vec)          _SOFTEN_TEST(EXC_STD, vec)
-#define SOFTEN_NOTEST_HV(vec)          _SOFTEN_TEST(EXC_HV, vec)
+#define SOFTEN_NOTEST_PR(vec, bitmask)         _SOFTEN_TEST(EXC_STD, vec, 
bitmask)
+#define SOFTEN_NOTEST_HV(vec, bitmask)         _SOFTEN_TEST(EXC_HV, vec, 
bitmask)
 
-#define __MASKABLE_EXCEPTION_PSERIES(vec, label, h, extra)             \
+#define __MASKABLE_EXCEPTION_PSERIES(vec, label, h, extra, bitmask)    \
        SET_SCRATCH0(r13);    /* save r13 */                            \
        EXCEPTION_PROLOG_0(PACA_EXGEN);                                 \
-       __EXCEPTION_PROLOG_1(PACA_EXGEN, extra, vec);                   \
+       MASKABLE_EXCEPTION_PROLOG_1(PACA_EXGEN, extra, vec, bitmask);           
\
        EXCEPTION_PROLOG_PSERIES_1(label##_common, h);
 
-#define _MASKABLE_EXCEPTION_PSERIES(vec, label, h, extra)              \
-       __MASKABLE_EXCEPTION_PSERIES(vec, label, h, extra)
+#define _MASKABLE_EXCEPTION_PSERIES(vec, label, h, extra, bitmask)     \
+       __MASKABLE_EXCEPTION_PSERIES(vec, label, h, extra, bitmask)
 
-#define MASKABLE_EXCEPTION_PSERIES(loc, vec, label)                    \
+#define MASKABLE_EXCEPTION_PSERIES(loc, vec, label, bitmask)           \
        . = loc;                                                        \
        .globl label##_pSeries;                                         \
 label##_pSeries:                                                       \
        _MASKABLE_EXCEPTION_PSERIES(vec, label,                         \
-                                   EXC_STD, SOFTEN_TEST_PR)
+                                   EXC_STD, SOFTEN_TEST_PR, bitmask)
 
-#define MASKABLE_EXCEPTION_HV(loc, vec, label)                         \
+#define MASKABLE_EXCEPTION_HV(loc, vec, label, bitmask)                        
\
        . = loc;                                                        \
        .globl label##_hv;                                              \
 label##_hv:                                                            \
        _MASKABLE_EXCEPTION_PSERIES(vec, label,                         \
-                                   EXC_HV, SOFTEN_TEST_HV)
+                                   EXC_HV, SOFTEN_TEST_HV, bitmask)
 
-#define MASKABLE_EXCEPTION_HV_OOL(vec, label)                          \
+#define MASKABLE_EXCEPTION_HV_OOL(vec, label, bitmask)                 \
        .globl label##_hv;                                              \
 label##_hv:                                                            \
-       __EXCEPTION_PROLOG_1(PACA_EXGEN, SOFTEN_TEST_HV, vec);          \
+       MASKABLE_EXCEPTION_PROLOG_1(PACA_EXGEN, SOFTEN_TEST_HV, vec, bitmask);  
\
        EXCEPTION_PROLOG_PSERIES_1(label##_common, EXC_HV);
 
-#define __MASKABLE_RELON_EXCEPTION_PSERIES(vec, label, h, extra)       \
+#define __MASKABLE_RELON_EXCEPTION_PSERIES(vec, label, h, extra, bitmask)\
        SET_SCRATCH0(r13);    /* save r13 */                            \
        EXCEPTION_PROLOG_0(PACA_EXGEN);                                 \
-       __EXCEPTION_PROLOG_1(PACA_EXGEN, extra, vec);           \
+       MASKABLE_EXCEPTION_PROLOG_1(PACA_EXGEN, extra, vec, bitmask);           
\
        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(vec, label, h, extra, bitmask)\
+       __MASKABLE_RELON_EXCEPTION_PSERIES(vec, label, h, extra, bitmask)
 
-#define MASKABLE_RELON_EXCEPTION_PSERIES(loc, vec, label)              \
+#define MASKABLE_RELON_EXCEPTION_PSERIES(loc, vec, label, bitmask)     \
        . = loc;                                                        \
        .globl label##_relon_pSeries;                                   \
 label##_relon_pSeries:                                                 \
        _MASKABLE_RELON_EXCEPTION_PSERIES(vec, label,                   \
-                                         EXC_STD, SOFTEN_NOTEST_PR)
+                                         EXC_STD, SOFTEN_NOTEST_PR, bitmask)
 
-#define MASKABLE_RELON_EXCEPTION_HV(loc, vec, label)                   \
+#define MASKABLE_RELON_EXCEPTION_HV(loc, vec, label, bitmask)          \
        . = loc;                                                        \
        .globl label##_relon_hv;                                        \
 label##_relon_hv:                                                      \
        _MASKABLE_RELON_EXCEPTION_PSERIES(vec, label,                   \
-                                         EXC_HV, SOFTEN_NOTEST_HV)
+                                         EXC_HV, SOFTEN_NOTEST_HV, bitmask)
 
-#define MASKABLE_RELON_EXCEPTION_HV_OOL(vec, label)                    \
+#define MASKABLE_RELON_EXCEPTION_HV_OOL(vec, label, bitmask)           \
        .globl label##_relon_hv;                                        \
 label##_relon_hv:                                                      \
-       __EXCEPTION_PROLOG_1(PACA_EXGEN, SOFTEN_NOTEST_HV, vec);                
\
+       MASKABLE_EXCEPTION_PROLOG_1(PACA_EXGEN, SOFTEN_NOTEST_HV, vec, 
bitmask);\
        EXCEPTION_PROLOG_PSERIES_1(label##_common, EXC_HV);
 
 /*
diff --git a/arch/powerpc/include/asm/irqflags.h 
b/arch/powerpc/include/asm/irqflags.h
index d0ed2a7d7d10..9ff09747a226 100644
--- a/arch/powerpc/include/asm/irqflags.h
+++ b/arch/powerpc/include/asm/irqflags.h
@@ -48,11 +48,11 @@
 #define RECONCILE_IRQ_STATE(__rA, __rB)                \
        lbz     __rA,PACASOFTIRQEN(r13);        \
        lbz     __rB,PACAIRQHAPPENED(r13);      \
-       cmpwi   cr0,__rA,IRQ_DISABLE_MASK_LINUX;\
+       andi.   __rA,__rA,IRQ_DISABLE_MASK_LINUX;\
        li      __rA,IRQ_DISABLE_MASK_LINUX;    \
        ori     __rB,__rB,PACA_IRQ_HARD_DIS;    \
        stb     __rB,PACAIRQHAPPENED(r13);      \
-       beq     44f;                            \
+       bne     44f;                            \
        stb     __rA,PACASOFTIRQEN(r13);        \
        TRACE_DISABLE_INTS;                     \
 44:
diff --git a/arch/powerpc/kernel/entry_64.S b/arch/powerpc/kernel/entry_64.S
index 879aeb11ad29..533e363914a9 100644
--- a/arch/powerpc/kernel/entry_64.S
+++ b/arch/powerpc/kernel/entry_64.S
@@ -764,8 +764,8 @@ restore:
         */
        ld      r5,SOFTE(r1)
        lbz     r6,PACASOFTIRQEN(r13)
-       cmpwi   cr0,r5,IRQ_DISABLE_MASK_LINUX
-       beq     restore_irq_off
+       andi.   r5,r5,IRQ_DISABLE_MASK_LINUX
+       bne     restore_irq_off
 
        /* We are enabling, were we already enabled ? Yes, just return */
        cmpwi   cr0,r6,IRQ_DISABLE_MASK_NONE
diff --git a/arch/powerpc/kernel/exceptions-64e.S 
b/arch/powerpc/kernel/exceptions-64e.S
index 5c628b5696f6..8e40df2c2f30 100644
--- a/arch/powerpc/kernel/exceptions-64e.S
+++ b/arch/powerpc/kernel/exceptions-64e.S
@@ -212,8 +212,8 @@ END_FTR_SECTION_IFSET(CPU_FTR_EMB_HV)
        /* Interrupts had better not already be enabled... */
        twnei   r6,IRQ_DISABLE_MASK_LINUX
 
-       cmpwi   cr0,r5,IRQ_DISABLE_MASK_LINUX
-       beq     1f
+       andi.   r5,r5,IRQ_DISABLE_MASK_LINUX
+       bne     1f
 
        TRACE_ENABLE_INTS
        stb     r5,PACASOFTIRQEN(r13)
@@ -352,7 +352,7 @@ ret_from_mc_except:
 
 #define PROLOG_ADDITION_MASKABLE_GEN(n)                                        
    \
        lbz     r10,PACASOFTIRQEN(r13); /* are irqs soft-disabled ? */      \
-       cmpwi   cr0,r10,IRQ_DISABLE_MASK_LINUX;/* yes -> go out of line */ \
+       andi.   r10,r10,IRQ_DISABLE_MASK_LINUX;/* yes -> go out of line */ \
        beq     masked_interrupt_book3e_##n
 
 #define PROLOG_ADDITION_2REGS_GEN(n)                                       \
diff --git a/arch/powerpc/kernel/exceptions-64s.S 
b/arch/powerpc/kernel/exceptions-64s.S
index bffec73dbffc..581a10bdb34a 100644
--- a/arch/powerpc/kernel/exceptions-64s.S
+++ b/arch/powerpc/kernel/exceptions-64s.S
@@ -221,11 +221,13 @@ hardware_interrupt_pSeries:
 hardware_interrupt_hv:
        BEGIN_FTR_SECTION
                _MASKABLE_EXCEPTION_PSERIES(0x502, hardware_interrupt,
-                                           EXC_HV, SOFTEN_TEST_HV)
+                                           EXC_HV, SOFTEN_TEST_HV,
+                                               IRQ_DISABLE_MASK_LINUX)
                KVM_HANDLER(PACA_EXGEN, EXC_HV, 0x502)
        FTR_SECTION_ELSE
                _MASKABLE_EXCEPTION_PSERIES(0x500, hardware_interrupt,
-                                           EXC_STD, SOFTEN_TEST_PR)
+                                           EXC_STD, SOFTEN_TEST_PR,
+                                               IRQ_DISABLE_MASK_LINUX)
                KVM_HANDLER(PACA_EXGEN, EXC_STD, 0x500)
        ALT_FTR_SECTION_END_IFSET(CPU_FTR_HVMODE | CPU_FTR_ARCH_206)
 
@@ -241,11 +243,13 @@ hardware_interrupt_hv:
        . = 0x900
        .globl decrementer_pSeries
 decrementer_pSeries:
-       _MASKABLE_EXCEPTION_PSERIES(0x900, decrementer, EXC_STD, SOFTEN_TEST_PR)
+       _MASKABLE_EXCEPTION_PSERIES(0x900, decrementer, EXC_STD, SOFTEN_TEST_PR,
+                                                       IRQ_DISABLE_MASK_LINUX)
 
        STD_EXCEPTION_HV(0x980, 0x982, hdecrementer)
 
-       MASKABLE_EXCEPTION_PSERIES(0xa00, 0xa00, doorbell_super)
+       MASKABLE_EXCEPTION_PSERIES(0xa00, 0xa00, doorbell_super,
+                                                       IRQ_DISABLE_MASK_LINUX)
        KVM_HANDLER(PACA_EXGEN, EXC_STD, 0xa00)
 
        STD_EXCEPTION_PSERIES(0xb00, trap_0b)
@@ -582,13 +586,13 @@ END_FTR_SECTION_IFSET(CPU_FTR_CFAR)
        KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe22)
        STD_EXCEPTION_HV_OOL(0xe42, emulation_assist)
        KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe42)
-       MASKABLE_EXCEPTION_HV_OOL(0xe62, hmi_exception)
+       MASKABLE_EXCEPTION_HV_OOL(0xe62, hmi_exception,IRQ_DISABLE_MASK_LINUX)
        KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe62)
 
-       MASKABLE_EXCEPTION_HV_OOL(0xe82, h_doorbell)
+       MASKABLE_EXCEPTION_HV_OOL(0xe82, h_doorbell,IRQ_DISABLE_MASK_LINUX)
        KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe82)
 
-       MASKABLE_EXCEPTION_HV_OOL(0xea2, h_virt_irq)
+       MASKABLE_EXCEPTION_HV_OOL(0xea2, h_virt_irq,IRQ_DISABLE_MASK_LINUX)
        KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xea2)
 
        /* moved from 0xf00 */
@@ -824,16 +828,20 @@ instruction_access_slb_relon_pSeries:
 hardware_interrupt_relon_pSeries:
 hardware_interrupt_relon_hv:
        BEGIN_FTR_SECTION
-               _MASKABLE_RELON_EXCEPTION_PSERIES(0x502, hardware_interrupt, 
EXC_HV, SOFTEN_TEST_HV)
+               _MASKABLE_RELON_EXCEPTION_PSERIES(0x502, hardware_interrupt,
+                       EXC_HV, SOFTEN_TEST_HV, IRQ_DISABLE_MASK_LINUX)
        FTR_SECTION_ELSE
-               _MASKABLE_RELON_EXCEPTION_PSERIES(0x500, hardware_interrupt, 
EXC_STD, SOFTEN_TEST_PR)
+               _MASKABLE_RELON_EXCEPTION_PSERIES(0x500, hardware_interrupt,
+                       EXC_STD, SOFTEN_TEST_PR, IRQ_DISABLE_MASK_LINUX)
        ALT_FTR_SECTION_END_IFSET(CPU_FTR_HVMODE)
        STD_RELON_EXCEPTION_PSERIES(0x4600, 0x600, alignment)
        STD_RELON_EXCEPTION_PSERIES(0x4700, 0x700, program_check)
        STD_RELON_EXCEPTION_PSERIES(0x4800, 0x800, fp_unavailable)
-       MASKABLE_RELON_EXCEPTION_PSERIES(0x4900, 0x900, decrementer)
+       MASKABLE_RELON_EXCEPTION_PSERIES(0x4900, 0x900, decrementer,
+                                                       IRQ_DISABLE_MASK_LINUX)
        STD_RELON_EXCEPTION_HV(0x4980, 0x982, hdecrementer)
-       MASKABLE_RELON_EXCEPTION_PSERIES(0x4a00, 0xa00, doorbell_super)
+       MASKABLE_RELON_EXCEPTION_PSERIES(0x4a00, 0xa00, doorbell_super,
+                                                       IRQ_DISABLE_MASK_LINUX)
        STD_RELON_EXCEPTION_PSERIES(0x4b00, 0xb00, trap_0b)
 
        . = 0x4c00
@@ -1132,8 +1140,10 @@ END_FTR_SECTION_IFSET(CPU_FTR_VSX)
 
        /* Equivalents to the above handlers for relocation-on interrupt 
vectors */
        STD_RELON_EXCEPTION_HV_OOL(0xe40, emulation_assist)
-       MASKABLE_RELON_EXCEPTION_HV_OOL(0xe80, h_doorbell)
-       MASKABLE_RELON_EXCEPTION_HV_OOL(0xea0, h_virt_irq)
+       MASKABLE_RELON_EXCEPTION_HV_OOL(0xe80, h_doorbell,
+                                                       IRQ_DISABLE_MASK_LINUX)
+       MASKABLE_RELON_EXCEPTION_HV_OOL(0xea0, h_virt_irq,
+                                                       IRQ_DISABLE_MASK_LINUX)
 
        STD_RELON_EXCEPTION_PSERIES_OOL(0xf00, performance_monitor)
        STD_RELON_EXCEPTION_PSERIES_OOL(0xf20, altivec_unavailable)
-- 
2.7.4

Reply via email to