| 1 |
/* |
| 2 |
* This file is subject to the terms and conditions of the GNU General Public |
| 3 |
* License. See the file "COPYING" in the main directory of this archive |
| 4 |
* for more details. |
| 5 |
* |
| 6 |
* Copyright (C) 2008 Maxime Bizon <[email protected]> |
| 7 |
* Copyright (C) 2008 Nicolas Schichan <[email protected]> |
| 8 |
*/ |
| 9 |
|
| 10 |
#include <linux/kernel.h> |
| 11 |
#include <linux/init.h> |
| 12 |
#include <linux/interrupt.h> |
| 13 |
#include <linux/irq.h> |
| 14 |
#include <linux/spinlock.h> |
| 15 |
#include <asm/irq_cpu.h> |
| 16 |
#include <asm/mipsregs.h> |
| 17 |
#include <bcm63xx_cpu.h> |
| 18 |
#include <bcm63xx_regs.h> |
| 19 |
#include <bcm63xx_io.h> |
| 20 |
#include <bcm63xx_irq.h> |
| 21 |
|
| 22 |
|
| 23 |
static DEFINE_SPINLOCK(ipic_lock); |
| 24 |
static DEFINE_SPINLOCK(epic_lock); |
| 25 |
|
| 26 |
static u32 irq_stat_addr[2]; |
| 27 |
static u32 irq_mask_addr[2]; |
| 28 |
static void (*dispatch_internal)(int cpu); |
| 29 |
static int is_ext_irq_cascaded; |
| 30 |
static unsigned int ext_irq_count; |
| 31 |
static unsigned int ext_irq_start, ext_irq_end; |
| 32 |
static unsigned int ext_irq_cfg_reg1, ext_irq_cfg_reg2; |
| 33 |
static void (*internal_irq_mask)(struct irq_data *d); |
| 34 |
static void (*internal_irq_unmask)(struct irq_data *d, const struct cpumask *m); |
| 35 |
|
| 36 |
|
| 37 |
static inline u32 get_ext_irq_perf_reg(int irq) |
| 38 |
{ |
| 39 |
if (irq < 4) |
| 40 |
return ext_irq_cfg_reg1; |
| 41 |
return ext_irq_cfg_reg2; |
| 42 |
} |
| 43 |
|
| 44 |
static inline void handle_internal(int intbit) |
| 45 |
{ |
| 46 |
if (is_ext_irq_cascaded && |
| 47 |
intbit >= ext_irq_start && intbit <= ext_irq_end) |
| 48 |
do_IRQ(intbit - ext_irq_start + IRQ_EXTERNAL_BASE); |
| 49 |
else |
| 50 |
do_IRQ(intbit + IRQ_INTERNAL_BASE); |
| 51 |
} |
| 52 |
|
| 53 |
static inline int enable_irq_for_cpu(int cpu, struct irq_data *d, |
| 54 |
const struct cpumask *m) |
| 55 |
{ |
| 56 |
bool enable = cpu_online(cpu); |
| 57 |
|
| 58 |
#ifdef CONFIG_SMP |
| 59 |
if (m) |
| 60 |
enable &= cpumask_test_cpu(cpu, m); |
| 61 |
else if (irqd_affinity_was_set(d)) |
| 62 |
enable &= cpumask_test_cpu(cpu, irq_data_get_affinity_mask(d)); |
| 63 |
#endif |
| 64 |
return enable; |
| 65 |
} |
| 66 |
|
| 67 |
/* |
| 68 |
* dispatch internal devices IRQ (uart, enet, watchdog, ...). do not |
| 69 |
* prioritize any interrupt relatively to another. the static counter |
| 70 |
* will resume the loop where it ended the last time we left this |
| 71 |
* function. |
| 72 |
*/ |
| 73 |
|
| 74 |
#define BUILD_IPIC_INTERNAL(width) \ |
| 75 |
static void __dispatch_internal_##width(int cpu) \ |
| 76 |
{ \ |
| 77 |
u32 pending[width / 32]; \ |
| 78 |
unsigned int src, tgt; \ |
| 79 |
bool irqs_pending = false; \ |
| 80 |
static unsigned int i[2]; \ |
| 81 |
unsigned int *next = &i[cpu]; \ |
| 82 |
unsigned long flags; \ |
| 83 |
\ |
| 84 |
/* read registers in reverse order */ \ |
| 85 |
spin_lock_irqsave(&ipic_lock, flags); \ |
| 86 |
for (src = 0, tgt = (width / 32); src < (width / 32); src++) { \ |
| 87 |
u32 val; \ |
| 88 |
\ |
| 89 |
val = bcm_readl(irq_stat_addr[cpu] + src * sizeof(u32)); \ |
| 90 |
val &= bcm_readl(irq_mask_addr[cpu] + src * sizeof(u32)); \ |
| 91 |
pending[--tgt] = val; \ |
| 92 |
\ |
| 93 |
if (val) \ |
| 94 |
irqs_pending = true; \ |
| 95 |
} \ |
| 96 |
spin_unlock_irqrestore(&ipic_lock, flags); \ |
| 97 |
\ |
| 98 |
if (!irqs_pending) \ |
| 99 |
return; \ |
| 100 |
\ |
| 101 |
while (1) { \ |
| 102 |
unsigned int to_call = *next; \ |
| 103 |
\ |
| 104 |
*next = (*next + 1) & (width - 1); \ |
| 105 |
if (pending[to_call / 32] & (1 << (to_call & 0x1f))) { \ |
| 106 |
handle_internal(to_call); \ |
| 107 |
break; \ |
| 108 |
} \ |
| 109 |
} \ |
| 110 |
} \ |
| 111 |
\ |
| 112 |
static void __internal_irq_mask_##width(struct irq_data *d) \ |
| 113 |
{ \ |
| 114 |
u32 val; \ |
| 115 |
unsigned irq = d->irq - IRQ_INTERNAL_BASE; \ |
| 116 |
unsigned reg = (irq / 32) ^ (width/32 - 1); \ |
| 117 |
unsigned bit = irq & 0x1f; \ |
| 118 |
unsigned long flags; \ |
| 119 |
int cpu; \ |
| 120 |
\ |
| 121 |
spin_lock_irqsave(&ipic_lock, flags); \ |
| 122 |
for_each_present_cpu(cpu) { \ |
| 123 |
if (!irq_mask_addr[cpu]) \ |
| 124 |
break; \ |
| 125 |
\ |
| 126 |
val = bcm_readl(irq_mask_addr[cpu] + reg * sizeof(u32));\ |
| 127 |
val &= ~(1 << bit); \ |
| 128 |
bcm_writel(val, irq_mask_addr[cpu] + reg * sizeof(u32));\ |
| 129 |
} \ |
| 130 |
spin_unlock_irqrestore(&ipic_lock, flags); \ |
| 131 |
} \ |
| 132 |
\ |
| 133 |
static void __internal_irq_unmask_##width(struct irq_data *d, \ |
| 134 |
const struct cpumask *m) \ |
| 135 |
{ \ |
| 136 |
u32 val; \ |
| 137 |
unsigned irq = d->irq - IRQ_INTERNAL_BASE; \ |
| 138 |
unsigned reg = (irq / 32) ^ (width/32 - 1); \ |
| 139 |
unsigned bit = irq & 0x1f; \ |
| 140 |
unsigned long flags; \ |
| 141 |
int cpu; \ |
| 142 |
\ |
| 143 |
spin_lock_irqsave(&ipic_lock, flags); \ |
| 144 |
for_each_present_cpu(cpu) { \ |
| 145 |
if (!irq_mask_addr[cpu]) \ |
| 146 |
break; \ |
| 147 |
\ |
| 148 |
val = bcm_readl(irq_mask_addr[cpu] + reg * sizeof(u32));\ |
| 149 |
if (enable_irq_for_cpu(cpu, d, m)) \ |
| 150 |
val |= (1 << bit); \ |
| 151 |
else \ |
| 152 |
val &= ~(1 << bit); \ |
| 153 |
bcm_writel(val, irq_mask_addr[cpu] + reg * sizeof(u32));\ |
| 154 |
} \ |
| 155 |
spin_unlock_irqrestore(&ipic_lock, flags); \ |
| 156 |
} |
| 157 |
|
| 158 |
BUILD_IPIC_INTERNAL(32); |
| 159 |
BUILD_IPIC_INTERNAL(64); |
| 160 |
|
| 161 |
asmlinkage void plat_irq_dispatch(void) |
| 162 |
{ |
| 163 |
u32 cause; |
| 164 |
|
| 165 |
do { |
| 166 |
cause = read_c0_cause() & read_c0_status() & ST0_IM; |
| 167 |
|
| 168 |
if (!cause) |
| 169 |
break; |
| 170 |
|
| 171 |
if (cause & CAUSEF_IP7) |
| 172 |
do_IRQ(7); |
| 173 |
if (cause & CAUSEF_IP0) |
| 174 |
do_IRQ(0); |
| 175 |
if (cause & CAUSEF_IP1) |
| 176 |
do_IRQ(1); |
| 177 |
if (cause & CAUSEF_IP2) |
| 178 |
dispatch_internal(0); |
| 179 |
if (is_ext_irq_cascaded) { |
| 180 |
if (cause & CAUSEF_IP3) |
| 181 |
dispatch_internal(1); |
| 182 |
} else { |
| 183 |
if (cause & CAUSEF_IP3) |
| 184 |
do_IRQ(IRQ_EXT_0); |
| 185 |
if (cause & CAUSEF_IP4) |
| 186 |
do_IRQ(IRQ_EXT_1); |
| 187 |
if (cause & CAUSEF_IP5) |
| 188 |
do_IRQ(IRQ_EXT_2); |
| 189 |
if (cause & CAUSEF_IP6) |
| 190 |
do_IRQ(IRQ_EXT_3); |
| 191 |
} |
| 192 |
} while (1); |
| 193 |
} |
| 194 |
|
| 195 |
/* |
| 196 |
* internal IRQs operations: only mask/unmask on PERF irq mask |
| 197 |
* register. |
| 198 |
*/ |
| 199 |
static void bcm63xx_internal_irq_mask(struct irq_data *d) |
| 200 |
{ |
| 201 |
internal_irq_mask(d); |
| 202 |
} |
| 203 |
|
| 204 |
static void bcm63xx_internal_irq_unmask(struct irq_data *d) |
| 205 |
{ |
| 206 |
internal_irq_unmask(d, NULL); |
| 207 |
} |
| 208 |
|
| 209 |
/* |
| 210 |
* external IRQs operations: mask/unmask and clear on PERF external |
| 211 |
* irq control register. |
| 212 |
*/ |
| 213 |
static void bcm63xx_external_irq_mask(struct irq_data *d) |
| 214 |
{ |
| 215 |
unsigned int irq = d->irq - IRQ_EXTERNAL_BASE; |
| 216 |
u32 reg, regaddr; |
| 217 |
unsigned long flags; |
| 218 |
|
| 219 |
regaddr = get_ext_irq_perf_reg(irq); |
| 220 |
spin_lock_irqsave(&epic_lock, flags); |
| 221 |
reg = bcm_perf_readl(regaddr); |
| 222 |
|
| 223 |
if (BCMCPU_IS_6348()) |
| 224 |
reg &= ~EXTIRQ_CFG_MASK_6348(irq % 4); |
| 225 |
else |
| 226 |
reg &= ~EXTIRQ_CFG_MASK(irq % 4); |
| 227 |
|
| 228 |
bcm_perf_writel(reg, regaddr); |
| 229 |
spin_unlock_irqrestore(&epic_lock, flags); |
| 230 |
|
| 231 |
if (is_ext_irq_cascaded) |
| 232 |
internal_irq_mask(irq_get_irq_data(irq + ext_irq_start)); |
| 233 |
} |
| 234 |
|
| 235 |
static void bcm63xx_external_irq_unmask(struct irq_data *d) |
| 236 |
{ |
| 237 |
unsigned int irq = d->irq - IRQ_EXTERNAL_BASE; |
| 238 |
u32 reg, regaddr; |
| 239 |
unsigned long flags; |
| 240 |
|
| 241 |
regaddr = get_ext_irq_perf_reg(irq); |
| 242 |
spin_lock_irqsave(&epic_lock, flags); |
| 243 |
reg = bcm_perf_readl(regaddr); |
| 244 |
|
| 245 |
if (BCMCPU_IS_6348()) |
| 246 |
reg |= EXTIRQ_CFG_MASK_6348(irq % 4); |
| 247 |
else |
| 248 |
reg |= EXTIRQ_CFG_MASK(irq % 4); |
| 249 |
|
| 250 |
bcm_perf_writel(reg, regaddr); |
| 251 |
spin_unlock_irqrestore(&epic_lock, flags); |
| 252 |
|
| 253 |
if (is_ext_irq_cascaded) |
| 254 |
internal_irq_unmask(irq_get_irq_data(irq + ext_irq_start), |
| 255 |
NULL); |
| 256 |
} |
| 257 |
|
| 258 |
static void bcm63xx_external_irq_clear(struct irq_data *d) |
| 259 |
{ |
| 260 |
unsigned int irq = d->irq - IRQ_EXTERNAL_BASE; |
| 261 |
u32 reg, regaddr; |
| 262 |
unsigned long flags; |
| 263 |
|
| 264 |
regaddr = get_ext_irq_perf_reg(irq); |
| 265 |
spin_lock_irqsave(&epic_lock, flags); |
| 266 |
reg = bcm_perf_readl(regaddr); |
| 267 |
|
| 268 |
if (BCMCPU_IS_6348()) |
| 269 |
reg |= EXTIRQ_CFG_CLEAR_6348(irq % 4); |
| 270 |
else |
| 271 |
reg |= EXTIRQ_CFG_CLEAR(irq % 4); |
| 272 |
|
| 273 |
bcm_perf_writel(reg, regaddr); |
| 274 |
spin_unlock_irqrestore(&epic_lock, flags); |
| 275 |
} |
| 276 |
|
| 277 |
static int bcm63xx_external_irq_set_type(struct irq_data *d, |
| 278 |
unsigned int flow_type) |
| 279 |
{ |
| 280 |
unsigned int irq = d->irq - IRQ_EXTERNAL_BASE; |
| 281 |
u32 reg, regaddr; |
| 282 |
int levelsense, sense, bothedge; |
| 283 |
unsigned long flags; |
| 284 |
|
| 285 |
flow_type &= IRQ_TYPE_SENSE_MASK; |
| 286 |
|
| 287 |
if (flow_type == IRQ_TYPE_NONE) |
| 288 |
flow_type = IRQ_TYPE_LEVEL_LOW; |
| 289 |
|
| 290 |
levelsense = sense = bothedge = 0; |
| 291 |
switch (flow_type) { |
| 292 |
case IRQ_TYPE_EDGE_BOTH: |
| 293 |
bothedge = 1; |
| 294 |
break; |
| 295 |
|
| 296 |
case IRQ_TYPE_EDGE_RISING: |
| 297 |
sense = 1; |
| 298 |
break; |
| 299 |
|
| 300 |
case IRQ_TYPE_EDGE_FALLING: |
| 301 |
break; |
| 302 |
|
| 303 |
case IRQ_TYPE_LEVEL_HIGH: |
| 304 |
levelsense = 1; |
| 305 |
sense = 1; |
| 306 |
break; |
| 307 |
|
| 308 |
case IRQ_TYPE_LEVEL_LOW: |
| 309 |
levelsense = 1; |
| 310 |
break; |
| 311 |
|
| 312 |
default: |
| 313 |
pr_err("bogus flow type combination given !\n"); |
| 314 |
return -EINVAL; |
| 315 |
} |
| 316 |
|
| 317 |
regaddr = get_ext_irq_perf_reg(irq); |
| 318 |
spin_lock_irqsave(&epic_lock, flags); |
| 319 |
reg = bcm_perf_readl(regaddr); |
| 320 |
irq %= 4; |
| 321 |
|
| 322 |
switch (bcm63xx_get_cpu_id()) { |
| 323 |
case BCM6348_CPU_ID: |
| 324 |
if (levelsense) |
| 325 |
reg |= EXTIRQ_CFG_LEVELSENSE_6348(irq); |
| 326 |
else |
| 327 |
reg &= ~EXTIRQ_CFG_LEVELSENSE_6348(irq); |
| 328 |
if (sense) |
| 329 |
reg |= EXTIRQ_CFG_SENSE_6348(irq); |
| 330 |
else |
| 331 |
reg &= ~EXTIRQ_CFG_SENSE_6348(irq); |
| 332 |
if (bothedge) |
| 333 |
reg |= EXTIRQ_CFG_BOTHEDGE_6348(irq); |
| 334 |
else |
| 335 |
reg &= ~EXTIRQ_CFG_BOTHEDGE_6348(irq); |
| 336 |
break; |
| 337 |
|
| 338 |
case BCM3368_CPU_ID: |
| 339 |
case BCM6328_CPU_ID: |
| 340 |
case BCM6338_CPU_ID: |
| 341 |
case BCM6345_CPU_ID: |
| 342 |
case BCM6358_CPU_ID: |
| 343 |
case BCM6362_CPU_ID: |
| 344 |
case BCM6368_CPU_ID: |
| 345 |
if (levelsense) |
| 346 |
reg |= EXTIRQ_CFG_LEVELSENSE(irq); |
| 347 |
else |
| 348 |
reg &= ~EXTIRQ_CFG_LEVELSENSE(irq); |
| 349 |
if (sense) |
| 350 |
reg |= EXTIRQ_CFG_SENSE(irq); |
| 351 |
else |
| 352 |
reg &= ~EXTIRQ_CFG_SENSE(irq); |
| 353 |
if (bothedge) |
| 354 |
reg |= EXTIRQ_CFG_BOTHEDGE(irq); |
| 355 |
else |
| 356 |
reg &= ~EXTIRQ_CFG_BOTHEDGE(irq); |
| 357 |
break; |
| 358 |
default: |
| 359 |
BUG(); |
| 360 |
} |
| 361 |
|
| 362 |
bcm_perf_writel(reg, regaddr); |
| 363 |
spin_unlock_irqrestore(&epic_lock, flags); |
| 364 |
|
| 365 |
irqd_set_trigger_type(d, flow_type); |
| 366 |
if (flow_type & (IRQ_TYPE_LEVEL_LOW | IRQ_TYPE_LEVEL_HIGH)) |
| 367 |
irq_set_handler_locked(d, handle_level_irq); |
| 368 |
else |
| 369 |
irq_set_handler_locked(d, handle_edge_irq); |
| 370 |
|
| 371 |
return IRQ_SET_MASK_OK_NOCOPY; |
| 372 |
} |
| 373 |
|
| 374 |
#ifdef CONFIG_SMP |
| 375 |
static int bcm63xx_internal_set_affinity(struct irq_data *data, |
| 376 |
const struct cpumask *dest, |
| 377 |
bool force) |
| 378 |
{ |
| 379 |
if (!irqd_irq_disabled(data)) |
| 380 |
internal_irq_unmask(data, dest); |
| 381 |
|
| 382 |
return 0; |
| 383 |
} |
| 384 |
#endif |
| 385 |
|
| 386 |
static struct irq_chip bcm63xx_internal_irq_chip = { |
| 387 |
.name = "bcm63xx_ipic", |
| 388 |
.irq_mask = bcm63xx_internal_irq_mask, |
| 389 |
.irq_unmask = bcm63xx_internal_irq_unmask, |
| 390 |
}; |
| 391 |
|
| 392 |
static struct irq_chip bcm63xx_external_irq_chip = { |
| 393 |
.name = "bcm63xx_epic", |
| 394 |
.irq_ack = bcm63xx_external_irq_clear, |
| 395 |
|
| 396 |
.irq_mask = bcm63xx_external_irq_mask, |
| 397 |
.irq_unmask = bcm63xx_external_irq_unmask, |
| 398 |
|
| 399 |
.irq_set_type = bcm63xx_external_irq_set_type, |
| 400 |
}; |
| 401 |
|
| 402 |
static void bcm63xx_init_irq(void) |
| 403 |
{ |
| 404 |
int irq_bits; |
| 405 |
|
| 406 |
irq_stat_addr[0] = bcm63xx_regset_address(RSET_PERF); |
| 407 |
irq_mask_addr[0] = bcm63xx_regset_address(RSET_PERF); |
| 408 |
irq_stat_addr[1] = bcm63xx_regset_address(RSET_PERF); |
| 409 |
irq_mask_addr[1] = bcm63xx_regset_address(RSET_PERF); |
| 410 |
|
| 411 |
switch (bcm63xx_get_cpu_id()) { |
| 412 |
case BCM3368_CPU_ID: |
| 413 |
irq_stat_addr[0] += PERF_IRQSTAT_3368_REG; |
| 414 |
irq_mask_addr[0] += PERF_IRQMASK_3368_REG; |
| 415 |
irq_stat_addr[1] = 0; |
| 416 |
irq_mask_addr[1] = 0; |
| 417 |
irq_bits = 32; |
| 418 |
ext_irq_count = 4; |
| 419 |
ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_3368; |
| 420 |
break; |
| 421 |
case BCM6328_CPU_ID: |
| 422 |
irq_stat_addr[0] += PERF_IRQSTAT_6328_REG(0); |
| 423 |
irq_mask_addr[0] += PERF_IRQMASK_6328_REG(0); |
| 424 |
irq_stat_addr[1] += PERF_IRQSTAT_6328_REG(1); |
| 425 |
irq_mask_addr[1] += PERF_IRQMASK_6328_REG(1); |
| 426 |
irq_bits = 64; |
| 427 |
ext_irq_count = 4; |
| 428 |
is_ext_irq_cascaded = 1; |
| 429 |
ext_irq_start = BCM_6328_EXT_IRQ0 - IRQ_INTERNAL_BASE; |
| 430 |
ext_irq_end = BCM_6328_EXT_IRQ3 - IRQ_INTERNAL_BASE; |
| 431 |
ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_6328; |
| 432 |
break; |
| 433 |
case BCM6338_CPU_ID: |
| 434 |
irq_stat_addr[0] += PERF_IRQSTAT_6338_REG; |
| 435 |
irq_mask_addr[0] += PERF_IRQMASK_6338_REG; |
| 436 |
irq_stat_addr[1] = 0; |
| 437 |
irq_mask_addr[1] = 0; |
| 438 |
irq_bits = 32; |
| 439 |
ext_irq_count = 4; |
| 440 |
ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_6338; |
| 441 |
break; |
| 442 |
case BCM6345_CPU_ID: |
| 443 |
irq_stat_addr[0] += PERF_IRQSTAT_6345_REG; |
| 444 |
irq_mask_addr[0] += PERF_IRQMASK_6345_REG; |
| 445 |
irq_stat_addr[1] = 0; |
| 446 |
irq_mask_addr[1] = 0; |
| 447 |
irq_bits = 32; |
| 448 |
ext_irq_count = 4; |
| 449 |
ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_6345; |
| 450 |
break; |
| 451 |
case BCM6348_CPU_ID: |
| 452 |
irq_stat_addr[0] += PERF_IRQSTAT_6348_REG; |
| 453 |
irq_mask_addr[0] += PERF_IRQMASK_6348_REG; |
| 454 |
irq_stat_addr[1] = 0; |
| 455 |
irq_mask_addr[1] = 0; |
| 456 |
irq_bits = 32; |
| 457 |
ext_irq_count = 4; |
| 458 |
ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_6348; |
| 459 |
break; |
| 460 |
case BCM6358_CPU_ID: |
| 461 |
irq_stat_addr[0] += PERF_IRQSTAT_6358_REG(0); |
| 462 |
irq_mask_addr[0] += PERF_IRQMASK_6358_REG(0); |
| 463 |
irq_stat_addr[1] += PERF_IRQSTAT_6358_REG(1); |
| 464 |
irq_mask_addr[1] += PERF_IRQMASK_6358_REG(1); |
| 465 |
irq_bits = 32; |
| 466 |
ext_irq_count = 4; |
| 467 |
is_ext_irq_cascaded = 1; |
| 468 |
ext_irq_start = BCM_6358_EXT_IRQ0 - IRQ_INTERNAL_BASE; |
| 469 |
ext_irq_end = BCM_6358_EXT_IRQ3 - IRQ_INTERNAL_BASE; |
| 470 |
ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_6358; |
| 471 |
break; |
| 472 |
case BCM6362_CPU_ID: |
| 473 |
irq_stat_addr[0] += PERF_IRQSTAT_6362_REG(0); |
| 474 |
irq_mask_addr[0] += PERF_IRQMASK_6362_REG(0); |
| 475 |
irq_stat_addr[1] += PERF_IRQSTAT_6362_REG(1); |
| 476 |
irq_mask_addr[1] += PERF_IRQMASK_6362_REG(1); |
| 477 |
irq_bits = 64; |
| 478 |
ext_irq_count = 4; |
| 479 |
is_ext_irq_cascaded = 1; |
| 480 |
ext_irq_start = BCM_6362_EXT_IRQ0 - IRQ_INTERNAL_BASE; |
| 481 |
ext_irq_end = BCM_6362_EXT_IRQ3 - IRQ_INTERNAL_BASE; |
| 482 |
ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_6362; |
| 483 |
break; |
| 484 |
case BCM6368_CPU_ID: |
| 485 |
irq_stat_addr[0] += PERF_IRQSTAT_6368_REG(0); |
| 486 |
irq_mask_addr[0] += PERF_IRQMASK_6368_REG(0); |
| 487 |
irq_stat_addr[1] += PERF_IRQSTAT_6368_REG(1); |
| 488 |
irq_mask_addr[1] += PERF_IRQMASK_6368_REG(1); |
| 489 |
irq_bits = 64; |
| 490 |
ext_irq_count = 6; |
| 491 |
is_ext_irq_cascaded = 1; |
| 492 |
ext_irq_start = BCM_6368_EXT_IRQ0 - IRQ_INTERNAL_BASE; |
| 493 |
ext_irq_end = BCM_6368_EXT_IRQ5 - IRQ_INTERNAL_BASE; |
| 494 |
ext_irq_cfg_reg1 = PERF_EXTIRQ_CFG_REG_6368; |
| 495 |
ext_irq_cfg_reg2 = PERF_EXTIRQ_CFG_REG2_6368; |
| 496 |
break; |
| 497 |
default: |
| 498 |
BUG(); |
| 499 |
} |
| 500 |
|
| 501 |
if (irq_bits == 32) { |
| 502 |
dispatch_internal = __dispatch_internal_32; |
| 503 |
internal_irq_mask = __internal_irq_mask_32; |
| 504 |
internal_irq_unmask = __internal_irq_unmask_32; |
| 505 |
} else { |
| 506 |
dispatch_internal = __dispatch_internal_64; |
| 507 |
internal_irq_mask = __internal_irq_mask_64; |
| 508 |
internal_irq_unmask = __internal_irq_unmask_64; |
| 509 |
} |
| 510 |
} |
| 511 |
|
| 512 |
void __init arch_init_irq(void) |
| 513 |
{ |
| 514 |
int i, irq; |
| 515 |
|
| 516 |
bcm63xx_init_irq(); |
| 517 |
mips_cpu_irq_init(); |
| 518 |
for (i = IRQ_INTERNAL_BASE; i < NR_IRQS; ++i) |
| 519 |
irq_set_chip_and_handler(i, &bcm63xx_internal_irq_chip, |
| 520 |
handle_level_irq); |
| 521 |
|
| 522 |
for (i = IRQ_EXTERNAL_BASE; i < IRQ_EXTERNAL_BASE + ext_irq_count; ++i) |
| 523 |
irq_set_chip_and_handler(i, &bcm63xx_external_irq_chip, |
| 524 |
handle_edge_irq); |
| 525 |
|
| 526 |
if (!is_ext_irq_cascaded) { |
| 527 |
for (i = 3; i < 3 + ext_irq_count; ++i) { |
| 528 |
irq = MIPS_CPU_IRQ_BASE + i; |
| 529 |
if (request_irq(irq, no_action, IRQF_NO_THREAD, |
| 530 |
"cascade_extirq", NULL)) { |
| 531 |
pr_err("Failed to request irq %d (cascade_extirq)\n", |
| 532 |
irq); |
| 533 |
} |
| 534 |
} |
| 535 |
} |
| 536 |
|
| 537 |
irq = MIPS_CPU_IRQ_BASE + 2; |
| 538 |
if (request_irq(irq, no_action, IRQF_NO_THREAD, "cascade_ip2", NULL)) |
| 539 |
pr_err("Failed to request irq %d (cascade_ip2)\n", irq); |
| 540 |
#ifdef CONFIG_SMP |
| 541 |
if (is_ext_irq_cascaded) { |
| 542 |
irq = MIPS_CPU_IRQ_BASE + 3; |
| 543 |
if (request_irq(irq, no_action, IRQF_NO_THREAD, "cascade_ip3", |
| 544 |
NULL)) |
| 545 |
pr_err("Failed to request irq %d (cascade_ip3)\n", irq); |
| 546 |
bcm63xx_internal_irq_chip.irq_set_affinity = |
| 547 |
bcm63xx_internal_set_affinity; |
| 548 |
|
| 549 |
cpumask_clear(irq_default_affinity); |
| 550 |
cpumask_set_cpu(smp_processor_id(), irq_default_affinity); |
| 551 |
} |
| 552 |
#endif |
| 553 |
} |