|
|
@@ -0,0 +1,258 @@
|
|
|
+From 6ec70ebfccd31ae3668d99b5703e5c9ce38384b4 Mon Sep 17 00:00:00 2001
|
|
|
+From: Jonas Gorski <[email protected]>
|
|
|
+Date: Thu, 25 Apr 2013 00:24:06 +0200
|
|
|
+Subject: [PATCH 06/13] MIPS: BCM63XX: append cpu number to irq_{stat,mask}*
|
|
|
+
|
|
|
+For SMP affinity support we need to discrimnate between the registers
|
|
|
+for both CPUs.
|
|
|
+
|
|
|
+Signed-off-by: Jonas Gorski <[email protected]>
|
|
|
+---
|
|
|
+ arch/mips/bcm63xx/irq.c | 78 ++++++++++-----------
|
|
|
+ arch/mips/include/asm/mach-bcm63xx/bcm63xx_regs.h | 16 ++---
|
|
|
+ 2 files changed, 47 insertions(+), 47 deletions(-)
|
|
|
+
|
|
|
+--- a/arch/mips/bcm63xx/irq.c
|
|
|
++++ b/arch/mips/bcm63xx/irq.c
|
|
|
+@@ -28,8 +28,8 @@ static void __internal_irq_unmask_64(uns
|
|
|
+
|
|
|
+ #ifndef BCMCPU_RUNTIME_DETECT
|
|
|
+ #ifdef CONFIG_BCM63XX_CPU_6328
|
|
|
+-#define irq_stat_reg PERF_IRQSTAT_6328_REG
|
|
|
+-#define irq_mask_reg PERF_IRQMASK_6328_REG
|
|
|
++#define irq_stat_reg0 PERF_IRQSTAT_6328_REG(0)
|
|
|
++#define irq_mask_reg0 PERF_IRQMASK_6328_REG(0)
|
|
|
+ #define irq_bits 64
|
|
|
+ #define is_ext_irq_cascaded 1
|
|
|
+ #define ext_irq_start (BCM_6328_EXT_IRQ0 - IRQ_INTERNAL_BASE)
|
|
|
+@@ -39,8 +39,8 @@ static void __internal_irq_unmask_64(uns
|
|
|
+ #define ext_irq_cfg_reg2 0
|
|
|
+ #endif
|
|
|
+ #ifdef CONFIG_BCM63XX_CPU_6338
|
|
|
+-#define irq_stat_reg PERF_IRQSTAT_6338_REG
|
|
|
+-#define irq_mask_reg PERF_IRQMASK_6338_REG
|
|
|
++#define irq_stat_reg0 PERF_IRQSTAT_6338_REG
|
|
|
++#define irq_mask_reg0 PERF_IRQMASK_6338_REG
|
|
|
+ #define irq_bits 32
|
|
|
+ #define is_ext_irq_cascaded 0
|
|
|
+ #define ext_irq_start 0
|
|
|
+@@ -50,8 +50,8 @@ static void __internal_irq_unmask_64(uns
|
|
|
+ #define ext_irq_cfg_reg2 0
|
|
|
+ #endif
|
|
|
+ #ifdef CONFIG_BCM63XX_CPU_6345
|
|
|
+-#define irq_stat_reg PERF_IRQSTAT_6345_REG
|
|
|
+-#define irq_mask_reg PERF_IRQMASK_6345_REG
|
|
|
++#define irq_stat_reg0 PERF_IRQSTAT_6345_REG
|
|
|
++#define irq_mask_reg0 PERF_IRQMASK_6345_REG
|
|
|
+ #define irq_bits 32
|
|
|
+ #define is_ext_irq_cascaded 0
|
|
|
+ #define ext_irq_start 0
|
|
|
+@@ -61,8 +61,8 @@ static void __internal_irq_unmask_64(uns
|
|
|
+ #define ext_irq_cfg_reg2 0
|
|
|
+ #endif
|
|
|
+ #ifdef CONFIG_BCM63XX_CPU_6348
|
|
|
+-#define irq_stat_reg PERF_IRQSTAT_6348_REG
|
|
|
+-#define irq_mask_reg PERF_IRQMASK_6348_REG
|
|
|
++#define irq_stat_reg0 PERF_IRQSTAT_6348_REG
|
|
|
++#define irq_mask_reg0 PERF_IRQMASK_6348_REG
|
|
|
+ #define irq_bits 32
|
|
|
+ #define is_ext_irq_cascaded 0
|
|
|
+ #define ext_irq_start 0
|
|
|
+@@ -72,8 +72,8 @@ static void __internal_irq_unmask_64(uns
|
|
|
+ #define ext_irq_cfg_reg2 0
|
|
|
+ #endif
|
|
|
+ #ifdef CONFIG_BCM63XX_CPU_6358
|
|
|
+-#define irq_stat_reg PERF_IRQSTAT_6358_REG
|
|
|
+-#define irq_mask_reg PERF_IRQMASK_6358_REG
|
|
|
++#define irq_stat_reg0 PERF_IRQSTAT_6358_REG(0)
|
|
|
++#define irq_mask_reg0 PERF_IRQMASK_6358_REG(0)
|
|
|
+ #define irq_bits 32
|
|
|
+ #define is_ext_irq_cascaded 1
|
|
|
+ #define ext_irq_start (BCM_6358_EXT_IRQ0 - IRQ_INTERNAL_BASE)
|
|
|
+@@ -83,8 +83,8 @@ static void __internal_irq_unmask_64(uns
|
|
|
+ #define ext_irq_cfg_reg2 0
|
|
|
+ #endif
|
|
|
+ #ifdef CONFIG_BCM63XX_CPU_6362
|
|
|
+-#define irq_stat_reg PERF_IRQSTAT_6362_REG
|
|
|
+-#define irq_mask_reg PERF_IRQMASK_6362_REG
|
|
|
++#define irq_stat_reg0 PERF_IRQSTAT_6362_REG(0)
|
|
|
++#define irq_mask_reg0 PERF_IRQMASK_6362_REG(0)
|
|
|
+ #define irq_bits 64
|
|
|
+ #define is_ext_irq_cascaded 1
|
|
|
+ #define ext_irq_start (BCM_6362_EXT_IRQ0 - IRQ_INTERNAL_BASE)
|
|
|
+@@ -94,8 +94,8 @@ static void __internal_irq_unmask_64(uns
|
|
|
+ #define ext_irq_cfg_reg2 0
|
|
|
+ #endif
|
|
|
+ #ifdef CONFIG_BCM63XX_CPU_6368
|
|
|
+-#define irq_stat_reg PERF_IRQSTAT_6368_REG
|
|
|
+-#define irq_mask_reg PERF_IRQMASK_6368_REG
|
|
|
++#define irq_stat_reg0 PERF_IRQSTAT_6368_REG(0)
|
|
|
++#define irq_mask_reg0 PERF_IRQMASK_6368_REG(0)
|
|
|
+ #define irq_bits 64
|
|
|
+ #define is_ext_irq_cascaded 1
|
|
|
+ #define ext_irq_start (BCM_6368_EXT_IRQ0 - IRQ_INTERNAL_BASE)
|
|
|
+@@ -115,15 +115,15 @@ static void __internal_irq_unmask_64(uns
|
|
|
+ #define internal_irq_unmask __internal_irq_unmask_64
|
|
|
+ #endif
|
|
|
+
|
|
|
+-#define irq_stat_addr (bcm63xx_regset_address(RSET_PERF) + irq_stat_reg)
|
|
|
+-#define irq_mask_addr (bcm63xx_regset_address(RSET_PERF) + irq_mask_reg)
|
|
|
++#define irq_stat_addr0 (bcm63xx_regset_address(RSET_PERF) + irq_stat_reg0)
|
|
|
++#define irq_mask_addr0 (bcm63xx_regset_address(RSET_PERF) + irq_mask_reg0)
|
|
|
+
|
|
|
+ static inline void bcm63xx_init_irq(void)
|
|
|
+ {
|
|
|
+ }
|
|
|
+ #else /* ! BCMCPU_RUNTIME_DETECT */
|
|
|
+
|
|
|
+-static u32 irq_stat_addr, irq_mask_addr;
|
|
|
++static u32 irq_stat_addr0, irq_mask_addr0;
|
|
|
+ static void (*dispatch_internal)(void);
|
|
|
+ static int is_ext_irq_cascaded;
|
|
|
+ static unsigned int ext_irq_count;
|
|
|
+@@ -136,13 +136,13 @@ static void bcm63xx_init_irq(void)
|
|
|
+ {
|
|
|
+ int irq_bits;
|
|
|
+
|
|
|
+- irq_stat_addr = bcm63xx_regset_address(RSET_PERF);
|
|
|
+- irq_mask_addr = bcm63xx_regset_address(RSET_PERF);
|
|
|
++ irq_stat_addr0 = bcm63xx_regset_address(RSET_PERF);
|
|
|
++ irq_mask_addr0 = bcm63xx_regset_address(RSET_PERF);
|
|
|
+
|
|
|
+ switch (bcm63xx_get_cpu_id()) {
|
|
|
+ case BCM6328_CPU_ID:
|
|
|
+- irq_stat_addr += PERF_IRQSTAT_6328_REG;
|
|
|
+- irq_mask_addr += PERF_IRQMASK_6328_REG;
|
|
|
++ irq_stat_addr0 += PERF_IRQSTAT_6328_REG(0);
|
|
|
++ irq_mask_addr0 += PERF_IRQMASK_6328_REG(0);
|
|
|
+ irq_bits = 64;
|
|
|
+ ext_irq_count = 4;
|
|
|
+ is_ext_irq_cascaded = 1;
|
|
|
+@@ -151,29 +151,29 @@ static void bcm63xx_init_irq(void)
|
|
|
+ ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_6328;
|
|
|
+ break;
|
|
|
+ case BCM6338_CPU_ID:
|
|
|
+- irq_stat_addr += PERF_IRQSTAT_6338_REG;
|
|
|
+- irq_mask_addr += PERF_IRQMASK_6338_REG;
|
|
|
++ irq_stat_addr0 += PERF_IRQSTAT_6338_REG;
|
|
|
++ irq_mask_addr0 += PERF_IRQMASK_6338_REG;
|
|
|
+ irq_bits = 32;
|
|
|
+ ext_irq_count = 4;
|
|
|
+ ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_6338;
|
|
|
+ break;
|
|
|
+ case BCM6345_CPU_ID:
|
|
|
+- irq_stat_addr += PERF_IRQSTAT_6345_REG;
|
|
|
+- irq_mask_addr += PERF_IRQMASK_6345_REG;
|
|
|
++ irq_stat_addr0 += PERF_IRQSTAT_6345_REG;
|
|
|
++ irq_mask_addr0 += PERF_IRQMASK_6345_REG;
|
|
|
+ irq_bits = 32;
|
|
|
+ ext_irq_count = 4;
|
|
|
+ ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_6345;
|
|
|
+ break;
|
|
|
+ case BCM6348_CPU_ID:
|
|
|
+- irq_stat_addr += PERF_IRQSTAT_6348_REG;
|
|
|
+- irq_mask_addr += PERF_IRQMASK_6348_REG;
|
|
|
++ irq_stat_addr0 += PERF_IRQSTAT_6348_REG;
|
|
|
++ irq_mask_addr0 += PERF_IRQMASK_6348_REG;
|
|
|
+ irq_bits = 32;
|
|
|
+ ext_irq_count = 4;
|
|
|
+ ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_6348;
|
|
|
+ break;
|
|
|
+ case BCM6358_CPU_ID:
|
|
|
+- irq_stat_addr += PERF_IRQSTAT_6358_REG;
|
|
|
+- irq_mask_addr += PERF_IRQMASK_6358_REG;
|
|
|
++ irq_stat_addr0 += PERF_IRQSTAT_6358_REG(0);
|
|
|
++ irq_mask_addr0 += PERF_IRQMASK_6358_REG(0);
|
|
|
+ irq_bits = 32;
|
|
|
+ ext_irq_count = 4;
|
|
|
+ is_ext_irq_cascaded = 1;
|
|
|
+@@ -182,8 +182,8 @@ static void bcm63xx_init_irq(void)
|
|
|
+ ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_6358;
|
|
|
+ break;
|
|
|
+ case BCM6362_CPU_ID:
|
|
|
+- irq_stat_addr += PERF_IRQSTAT_6362_REG;
|
|
|
+- irq_mask_addr += PERF_IRQMASK_6362_REG;
|
|
|
++ irq_stat_addr0 += PERF_IRQSTAT_6362_REG(0);
|
|
|
++ irq_mask_addr0 += PERF_IRQMASK_6362_REG(0);
|
|
|
+ irq_bits = 64;
|
|
|
+ ext_irq_count = 4;
|
|
|
+ is_ext_irq_cascaded = 1;
|
|
|
+@@ -192,8 +192,8 @@ static void bcm63xx_init_irq(void)
|
|
|
+ ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_6362;
|
|
|
+ break;
|
|
|
+ case BCM6368_CPU_ID:
|
|
|
+- irq_stat_addr += PERF_IRQSTAT_6368_REG;
|
|
|
+- irq_mask_addr += PERF_IRQMASK_6368_REG;
|
|
|
++ irq_stat_addr0 += PERF_IRQSTAT_6368_REG(0);
|
|
|
++ irq_mask_addr0 += PERF_IRQMASK_6368_REG(0);
|
|
|
+ irq_bits = 64;
|
|
|
+ ext_irq_count = 6;
|
|
|
+ is_ext_irq_cascaded = 1;
|
|
|
+@@ -253,8 +253,8 @@ void __dispatch_internal_##width(void)
|
|
|
+ for (src = 0, tgt = (width / 32); src < (width / 32); src++) { \
|
|
|
+ u32 val; \
|
|
|
+ \
|
|
|
+- val = bcm_readl(irq_stat_addr + src * sizeof(u32)); \
|
|
|
+- val &= bcm_readl(irq_mask_addr + src * sizeof(u32)); \
|
|
|
++ val = bcm_readl(irq_stat_addr0 + src * sizeof(u32)); \
|
|
|
++ val &= bcm_readl(irq_mask_addr0 + src * sizeof(u32)); \
|
|
|
+ pending[--tgt] = val; \
|
|
|
+ \
|
|
|
+ if (val) \
|
|
|
+@@ -281,9 +281,9 @@ static void __internal_irq_mask_##width(
|
|
|
+ unsigned reg = (irq / 32) ^ (width/32 - 1); \
|
|
|
+ unsigned bit = irq & 0x1f; \
|
|
|
+ \
|
|
|
+- val = bcm_readl(irq_mask_addr + reg * sizeof(u32)); \
|
|
|
++ val = bcm_readl(irq_mask_addr0 + reg * sizeof(u32)); \
|
|
|
+ val &= ~(1 << bit); \
|
|
|
+- bcm_writel(val, irq_mask_addr + reg * sizeof(u32)); \
|
|
|
++ bcm_writel(val, irq_mask_addr0 + reg * sizeof(u32)); \
|
|
|
+ } \
|
|
|
+ \
|
|
|
+ static void __internal_irq_unmask_##width(unsigned int irq) \
|
|
|
+@@ -292,9 +292,9 @@ static void __internal_irq_unmask_##widt
|
|
|
+ unsigned reg = (irq / 32) ^ (width/32 - 1); \
|
|
|
+ unsigned bit = irq & 0x1f; \
|
|
|
+ \
|
|
|
+- val = bcm_readl(irq_mask_addr + reg * sizeof(u32)); \
|
|
|
++ val = bcm_readl(irq_mask_addr0 + reg * sizeof(u32)); \
|
|
|
+ val |= (1 << bit); \
|
|
|
+- bcm_writel(val, irq_mask_addr + reg * sizeof(u32)); \
|
|
|
++ bcm_writel(val, irq_mask_addr0 + reg * sizeof(u32)); \
|
|
|
+ }
|
|
|
+
|
|
|
+ BUILD_IPIC_INTERNAL(32);
|
|
|
+--- a/arch/mips/include/asm/mach-bcm63xx/bcm63xx_regs.h
|
|
|
++++ b/arch/mips/include/asm/mach-bcm63xx/bcm63xx_regs.h
|
|
|
+@@ -181,22 +181,22 @@
|
|
|
+ #define SYS_PLL_SOFT_RESET 0x1
|
|
|
+
|
|
|
+ /* Interrupt Mask register */
|
|
|
+-#define PERF_IRQMASK_6328_REG 0x20
|
|
|
++#define PERF_IRQMASK_6328_REG(x) (0x20 + (x) * 0x10)
|
|
|
+ #define PERF_IRQMASK_6338_REG 0xc
|
|
|
+ #define PERF_IRQMASK_6345_REG 0xc
|
|
|
+ #define PERF_IRQMASK_6348_REG 0xc
|
|
|
+-#define PERF_IRQMASK_6358_REG 0xc
|
|
|
+-#define PERF_IRQMASK_6362_REG 0x20
|
|
|
+-#define PERF_IRQMASK_6368_REG 0x20
|
|
|
++#define PERF_IRQMASK_6358_REG(x) (0xc + (x) * 0x2c)
|
|
|
++#define PERF_IRQMASK_6362_REG(x) (0x20 + (x) * 0x10)
|
|
|
++#define PERF_IRQMASK_6368_REG(x) (0x20 + (x) * 0x10)
|
|
|
+
|
|
|
+ /* Interrupt Status register */
|
|
|
+-#define PERF_IRQSTAT_6328_REG 0x28
|
|
|
++#define PERF_IRQSTAT_6328_REG(x) (0x28 + (x) * 0x10)
|
|
|
+ #define PERF_IRQSTAT_6338_REG 0x10
|
|
|
+ #define PERF_IRQSTAT_6345_REG 0x10
|
|
|
+ #define PERF_IRQSTAT_6348_REG 0x10
|
|
|
+-#define PERF_IRQSTAT_6358_REG 0x10
|
|
|
+-#define PERF_IRQSTAT_6362_REG 0x28
|
|
|
+-#define PERF_IRQSTAT_6368_REG 0x28
|
|
|
++#define PERF_IRQSTAT_6358_REG(x) (0x10 + (x) * 0x2c)
|
|
|
++#define PERF_IRQSTAT_6362_REG(x) (0x28 + (x) * 0x10)
|
|
|
++#define PERF_IRQSTAT_6368_REG(x) (0x28 + (x) * 0x10)
|
|
|
+
|
|
|
+ /* External Interrupt Configuration register */
|
|
|
+ #define PERF_EXTIRQ_CFG_REG_6328 0x18
|