diff options
| -rw-r--r-- | arch/mips/Kconfig | 2 | ||||
| -rw-r--r-- | arch/mips/Makefile | 14 | ||||
| -rw-r--r-- | arch/mips/sibyte/Kconfig | 10 | ||||
| -rw-r--r-- | arch/mips/sibyte/bcm1480/Makefile | 5 | ||||
| -rw-r--r-- | arch/mips/sibyte/bcm1480/irq.c | 476 | ||||
| -rw-r--r-- | arch/mips/sibyte/bcm1480/irq_handler.S | 165 | ||||
| -rw-r--r-- | arch/mips/sibyte/bcm1480/setup.c | 136 | ||||
| -rw-r--r-- | arch/mips/sibyte/bcm1480/smp.c | 110 | ||||
| -rw-r--r-- | arch/mips/sibyte/bcm1480/time.c | 138 | ||||
| -rw-r--r-- | arch/mips/sibyte/cfe/smp.c | 14 | ||||
| -rw-r--r-- | arch/mips/sibyte/swarm/setup.c | 28 |
11 files changed, 1093 insertions, 5 deletions
diff --git a/arch/mips/Kconfig b/arch/mips/Kconfig index bafd7755380d..fdeffc81e17a 100644 --- a/arch/mips/Kconfig +++ b/arch/mips/Kconfig | |||
| @@ -1429,7 +1429,7 @@ source "mm/Kconfig" | |||
| 1429 | 1429 | ||
| 1430 | config SMP | 1430 | config SMP |
| 1431 | bool "Multi-Processing support" | 1431 | bool "Multi-Processing support" |
| 1432 | depends on CPU_RM9000 || (SIBYTE_SB1250 && !SIBYTE_STANDALONE) || SGI_IP27 || MIPS_MT_SMP | 1432 | depends on CPU_RM9000 || ((SIBYTE_BCM1x80 || SIBYTE_BCM1x55 || SIBYTE_SB1250) && !SIBYTE_STANDALONE) || SGI_IP27 || MIPS_MT_SMP |
| 1433 | ---help--- | 1433 | ---help--- |
| 1434 | This enables support for systems with more than one CPU. If you have | 1434 | This enables support for systems with more than one CPU. If you have |
| 1435 | a system with only one CPU, like most personal computers, say N. If | 1435 | a system with only one CPU, like most personal computers, say N. If |
diff --git a/arch/mips/Makefile b/arch/mips/Makefile index 4d0645cb5725..92e16157734c 100644 --- a/arch/mips/Makefile +++ b/arch/mips/Makefile | |||
| @@ -650,10 +650,20 @@ load-$(CONFIG_SGI_IP32) += 0xffffffff80004000 | |||
| 650 | # removed (as happens, even if they have __initcall/module_init) | 650 | # removed (as happens, even if they have __initcall/module_init) |
| 651 | # | 651 | # |
| 652 | core-$(CONFIG_SIBYTE_BCM112X) += arch/mips/sibyte/sb1250/ | 652 | core-$(CONFIG_SIBYTE_BCM112X) += arch/mips/sibyte/sb1250/ |
| 653 | cflags-$(CONFIG_SIBYTE_BCM112X) += -Iinclude/asm-mips/mach-sibyte | 653 | cflags-$(CONFIG_SIBYTE_BCM112X) += -Iinclude/asm-mips/mach-sibyte \ |
| 654 | -DSIBYTE_HDR_FEATURES=SIBYTE_HDR_FMASK_1250_112x_ALL | ||
| 654 | 655 | ||
| 655 | core-$(CONFIG_SIBYTE_SB1250) += arch/mips/sibyte/sb1250/ | 656 | core-$(CONFIG_SIBYTE_SB1250) += arch/mips/sibyte/sb1250/ |
| 656 | cflags-$(CONFIG_SIBYTE_SB1250) += -Iinclude/asm-mips/mach-sibyte | 657 | cflags-$(CONFIG_SIBYTE_SB1250) += -Iinclude/asm-mips/mach-sibyte \ |
| 658 | -DSIBYTE_HDR_FEATURES=SIBYTE_HDR_FMASK_1250_112x_ALL | ||
| 659 | |||
| 660 | core-$(CONFIG_SIBYTE_BCM1x55) += arch/mips/sibyte/bcm1480/ | ||
| 661 | cflags-$(CONFIG_SIBYTE_BCM1x55) += -Iinclude/asm-mips/mach-sibyte \ | ||
| 662 | -DSIBYTE_HDR_FEATURES=SIBYTE_HDR_FMASK_1480_ALL | ||
| 663 | |||
| 664 | core-$(CONFIG_SIBYTE_BCM1x80) += arch/mips/sibyte/bcm1480/ | ||
| 665 | cflags-$(CONFIG_SIBYTE_BCM1x80) += -Iinclude/asm-mips/mach-sibyte \ | ||
| 666 | -DSIBYTE_HDR_FEATURES=SIBYTE_HDR_FMASK_1480_ALL | ||
| 657 | 667 | ||
| 658 | # | 668 | # |
| 659 | # Sibyte BCM91120x (Carmel) board | 669 | # Sibyte BCM91120x (Carmel) board |
diff --git a/arch/mips/sibyte/Kconfig b/arch/mips/sibyte/Kconfig index 3618d61f004a..6a5a08f5e212 100644 --- a/arch/mips/sibyte/Kconfig +++ b/arch/mips/sibyte/Kconfig | |||
| @@ -26,6 +26,16 @@ config SIBYTE_BCM112X | |||
| 26 | bool | 26 | bool |
| 27 | select SIBYTE_SB1xxx_SOC | 27 | select SIBYTE_SB1xxx_SOC |
| 28 | 28 | ||
| 29 | config SIBYTE_BCM1x80 | ||
| 30 | bool | ||
| 31 | select HW_HAS_PCI | ||
| 32 | select SIBYTE_SB1xxx_SOC | ||
| 33 | |||
| 34 | config SIBYTE_BCM1x55 | ||
| 35 | bool | ||
| 36 | select HW_HAS_PCI | ||
| 37 | select SIBYTE_SB1xxx_SOC | ||
| 38 | |||
| 29 | config SIBYTE_SB1xxx_SOC | 39 | config SIBYTE_SB1xxx_SOC |
| 30 | bool | 40 | bool |
| 31 | depends on EXPERIMENTAL | 41 | depends on EXPERIMENTAL |
diff --git a/arch/mips/sibyte/bcm1480/Makefile b/arch/mips/sibyte/bcm1480/Makefile new file mode 100644 index 000000000000..538d5a51ae94 --- /dev/null +++ b/arch/mips/sibyte/bcm1480/Makefile | |||
| @@ -0,0 +1,5 @@ | |||
| 1 | obj-y := setup.o irq.o irq_handler.o time.o | ||
| 2 | |||
| 3 | obj-$(CONFIG_SMP) += smp.o | ||
| 4 | |||
| 5 | EXTRA_AFLAGS := $(CFLAGS) | ||
diff --git a/arch/mips/sibyte/bcm1480/irq.c b/arch/mips/sibyte/bcm1480/irq.c new file mode 100644 index 000000000000..b2a1ba5d23df --- /dev/null +++ b/arch/mips/sibyte/bcm1480/irq.c | |||
| @@ -0,0 +1,476 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (C) 2000,2001,2002,2003,2004 Broadcom Corporation | ||
| 3 | * | ||
| 4 | * This program is free software; you can redistribute it and/or | ||
| 5 | * modify it under the terms of the GNU General Public License | ||
| 6 | * as published by the Free Software Foundation; either version 2 | ||
| 7 | * of the License, or (at your option) any later version. | ||
| 8 | * | ||
| 9 | * This program is distributed in the hope that it will be useful, | ||
| 10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 12 | * GNU General Public License for more details. | ||
| 13 | * | ||
| 14 | * You should have received a copy of the GNU General Public License | ||
| 15 | * along with this program; if not, write to the Free Software | ||
| 16 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | ||
| 17 | */ | ||
| 18 | #include <linux/config.h> | ||
| 19 | #include <linux/kernel.h> | ||
| 20 | #include <linux/init.h> | ||
| 21 | #include <linux/linkage.h> | ||
| 22 | #include <linux/interrupt.h> | ||
| 23 | #include <linux/spinlock.h> | ||
| 24 | #include <linux/mm.h> | ||
| 25 | #include <linux/slab.h> | ||
| 26 | #include <linux/kernel_stat.h> | ||
| 27 | |||
| 28 | #include <asm/errno.h> | ||
| 29 | #include <asm/signal.h> | ||
| 30 | #include <asm/system.h> | ||
| 31 | #include <asm/ptrace.h> | ||
| 32 | #include <asm/io.h> | ||
| 33 | |||
| 34 | #include <asm/sibyte/bcm1480_regs.h> | ||
| 35 | #include <asm/sibyte/bcm1480_int.h> | ||
| 36 | #include <asm/sibyte/bcm1480_scd.h> | ||
| 37 | |||
| 38 | #include <asm/sibyte/sb1250_uart.h> | ||
| 39 | #include <asm/sibyte/sb1250.h> | ||
| 40 | |||
| 41 | /* | ||
| 42 | * These are the routines that handle all the low level interrupt stuff. | ||
| 43 | * Actions handled here are: initialization of the interrupt map, requesting of | ||
| 44 | * interrupt lines by handlers, dispatching if interrupts to handlers, probing | ||
| 45 | * for interrupt lines | ||
| 46 | */ | ||
| 47 | |||
| 48 | |||
| 49 | #define shutdown_bcm1480_irq disable_bcm1480_irq | ||
| 50 | static void end_bcm1480_irq(unsigned int irq); | ||
| 51 | static void enable_bcm1480_irq(unsigned int irq); | ||
| 52 | static void disable_bcm1480_irq(unsigned int irq); | ||
| 53 | static unsigned int startup_bcm1480_irq(unsigned int irq); | ||
| 54 | static void ack_bcm1480_irq(unsigned int irq); | ||
| 55 | #ifdef CONFIG_SMP | ||
| 56 | static void bcm1480_set_affinity(unsigned int irq, cpumask_t mask); | ||
| 57 | #endif | ||
| 58 | |||
| 59 | #ifdef CONFIG_PCI | ||
| 60 | extern unsigned long ht_eoi_space; | ||
| 61 | #endif | ||
| 62 | |||
| 63 | #ifdef CONFIG_KGDB | ||
| 64 | #include <asm/gdb-stub.h> | ||
| 65 | extern void breakpoint(void); | ||
| 66 | static int kgdb_irq; | ||
| 67 | #ifdef CONFIG_GDB_CONSOLE | ||
| 68 | extern void register_gdb_console(void); | ||
| 69 | #endif | ||
| 70 | |||
| 71 | /* kgdb is on when configured. Pass "nokgdb" kernel arg to turn it off */ | ||
| 72 | static int kgdb_flag = 1; | ||
| 73 | static int __init nokgdb(char *str) | ||
| 74 | { | ||
| 75 | kgdb_flag = 0; | ||
| 76 | return 1; | ||
| 77 | } | ||
| 78 | __setup("nokgdb", nokgdb); | ||
| 79 | |||
| 80 | /* Default to UART1 */ | ||
| 81 | int kgdb_port = 1; | ||
| 82 | #ifdef CONFIG_SIBYTE_SB1250_DUART | ||
| 83 | extern char sb1250_duart_present[]; | ||
| 84 | #endif | ||
| 85 | #endif | ||
| 86 | |||
| 87 | static struct hw_interrupt_type bcm1480_irq_type = { | ||
| 88 | .typename = "BCM1480-IMR", | ||
| 89 | .startup = startup_bcm1480_irq, | ||
| 90 | .shutdown = shutdown_bcm1480_irq, | ||
| 91 | .enable = enable_bcm1480_irq, | ||
| 92 | .disable = disable_bcm1480_irq, | ||
| 93 | .ack = ack_bcm1480_irq, | ||
| 94 | .end = end_bcm1480_irq, | ||
| 95 | #ifdef CONFIG_SMP | ||
| 96 | .set_affinity = bcm1480_set_affinity | ||
| 97 | #endif | ||
| 98 | }; | ||
| 99 | |||
| 100 | /* Store the CPU id (not the logical number) */ | ||
| 101 | int bcm1480_irq_owner[BCM1480_NR_IRQS]; | ||
| 102 | |||
| 103 | DEFINE_SPINLOCK(bcm1480_imr_lock); | ||
| 104 | |||
| 105 | void bcm1480_mask_irq(int cpu, int irq) | ||
| 106 | { | ||
| 107 | unsigned long flags; | ||
| 108 | u64 cur_ints,hl_spacing; | ||
| 109 | |||
| 110 | spin_lock_irqsave(&bcm1480_imr_lock, flags); | ||
| 111 | hl_spacing = 0; | ||
| 112 | if ((irq >= BCM1480_NR_IRQS_HALF) && (irq <= BCM1480_NR_IRQS)) { | ||
| 113 | hl_spacing = BCM1480_IMR_HL_SPACING; | ||
| 114 | irq -= BCM1480_NR_IRQS_HALF; | ||
| 115 | } | ||
| 116 | cur_ints = ____raw_readq(IOADDR(A_BCM1480_IMR_MAPPER(cpu) + R_BCM1480_IMR_INTERRUPT_MASK_H + hl_spacing)); | ||
| 117 | cur_ints |= (((u64) 1) << irq); | ||
| 118 | ____raw_writeq(cur_ints, IOADDR(A_BCM1480_IMR_MAPPER(cpu) + R_BCM1480_IMR_INTERRUPT_MASK_H + hl_spacing)); | ||
| 119 | spin_unlock_irqrestore(&bcm1480_imr_lock, flags); | ||
| 120 | } | ||
| 121 | |||
| 122 | void bcm1480_unmask_irq(int cpu, int irq) | ||
| 123 | { | ||
| 124 | unsigned long flags; | ||
| 125 | u64 cur_ints,hl_spacing; | ||
| 126 | |||
| 127 | spin_lock_irqsave(&bcm1480_imr_lock, flags); | ||
| 128 | hl_spacing = 0; | ||
| 129 | if ((irq >= BCM1480_NR_IRQS_HALF) && (irq <= BCM1480_NR_IRQS)) { | ||
| 130 | hl_spacing = BCM1480_IMR_HL_SPACING; | ||
| 131 | irq -= BCM1480_NR_IRQS_HALF; | ||
| 132 | } | ||
| 133 | cur_ints = ____raw_readq(IOADDR(A_BCM1480_IMR_MAPPER(cpu) + R_BCM1480_IMR_INTERRUPT_MASK_H + hl_spacing)); | ||
| 134 | cur_ints &= ~(((u64) 1) << irq); | ||
| 135 | ____raw_writeq(cur_ints, IOADDR(A_BCM1480_IMR_MAPPER(cpu) + R_BCM1480_IMR_INTERRUPT_MASK_H + hl_spacing)); | ||
| 136 | spin_unlock_irqrestore(&bcm1480_imr_lock, flags); | ||
| 137 | } | ||
| 138 | |||
| 139 | #ifdef CONFIG_SMP | ||
| 140 | static void bcm1480_set_affinity(unsigned int irq, cpumask_t mask) | ||
| 141 | { | ||
| 142 | int i = 0, old_cpu, cpu, int_on; | ||
| 143 | u64 cur_ints; | ||
| 144 | irq_desc_t *desc = irq_desc + irq; | ||
| 145 | unsigned long flags; | ||
| 146 | unsigned int irq_dirty; | ||
| 147 | |||
| 148 | i = first_cpu(mask); | ||
| 149 | if (next_cpu(i, mask) <= NR_CPUS) { | ||
| 150 | printk("attempted to set irq affinity for irq %d to multiple CPUs\n", irq); | ||
| 151 | return; | ||
| 152 | } | ||
| 153 | |||
| 154 | /* Convert logical CPU to physical CPU */ | ||
| 155 | cpu = cpu_logical_map(i); | ||
| 156 | |||
| 157 | /* Protect against other affinity changers and IMR manipulation */ | ||
| 158 | spin_lock_irqsave(&desc->lock, flags); | ||
| 159 | spin_lock(&bcm1480_imr_lock); | ||
| 160 | |||
| 161 | /* Swizzle each CPU's IMR (but leave the IP selection alone) */ | ||
| 162 | old_cpu = bcm1480_irq_owner[irq]; | ||
| 163 | irq_dirty = irq; | ||
| 164 | if ((irq_dirty >= BCM1480_NR_IRQS_HALF) && (irq_dirty <= BCM1480_NR_IRQS)) { | ||
| 165 | irq_dirty -= BCM1480_NR_IRQS_HALF; | ||
| 166 | } | ||
| 167 | |||
| 168 | int k; | ||
| 169 | for (k=0; k<2; k++) { /* Loop through high and low interrupt mask register */ | ||
| 170 | cur_ints = ____raw_readq(IOADDR(A_BCM1480_IMR_MAPPER(old_cpu) + R_BCM1480_IMR_INTERRUPT_MASK_H + (k*BCM1480_IMR_HL_SPACING))); | ||
| 171 | int_on = !(cur_ints & (((u64) 1) << irq_dirty)); | ||
| 172 | if (int_on) { | ||
| 173 | /* If it was on, mask it */ | ||
| 174 | cur_ints |= (((u64) 1) << irq_dirty); | ||
| 175 | ____raw_writeq(cur_ints, IOADDR(A_BCM1480_IMR_MAPPER(old_cpu) + R_BCM1480_IMR_INTERRUPT_MASK_H + (k*BCM1480_IMR_HL_SPACING))); | ||
| 176 | } | ||
| 177 | bcm1480_irq_owner[irq] = cpu; | ||
| 178 | if (int_on) { | ||
| 179 | /* unmask for the new CPU */ | ||
| 180 | cur_ints = ____raw_readq(IOADDR(A_BCM1480_IMR_MAPPER(cpu) + R_BCM1480_IMR_INTERRUPT_MASK_H + (k*BCM1480_IMR_HL_SPACING))); | ||
| 181 | cur_ints &= ~(((u64) 1) << irq_dirty); | ||
| 182 | ____raw_writeq(cur_ints, IOADDR(A_BCM1480_IMR_MAPPER(cpu) + R_BCM1480_IMR_INTERRUPT_MASK_H + (k*BCM1480_IMR_HL_SPACING))); | ||
| 183 | } | ||
| 184 | } | ||
| 185 | spin_unlock(&bcm1480_imr_lock); | ||
| 186 | spin_unlock_irqrestore(&desc->lock, flags); | ||
| 187 | } | ||
| 188 | #endif | ||
| 189 | |||
| 190 | |||
| 191 | /* Defined in arch/mips/sibyte/bcm1480/irq_handler.S */ | ||
| 192 | extern void bcm1480_irq_handler(void); | ||
| 193 | |||
| 194 | /*****************************************************************************/ | ||
| 195 | |||
| 196 | static unsigned int startup_bcm1480_irq(unsigned int irq) | ||
| 197 | { | ||
| 198 | bcm1480_unmask_irq(bcm1480_irq_owner[irq], irq); | ||
| 199 | |||
| 200 | return 0; /* never anything pending */ | ||
| 201 | } | ||
| 202 | |||
| 203 | |||
| 204 | static void disable_bcm1480_irq(unsigned int irq) | ||
| 205 | { | ||
| 206 | bcm1480_mask_irq(bcm1480_irq_owner[irq], irq); | ||
| 207 | } | ||
| 208 | |||
| 209 | static void enable_bcm1480_irq(unsigned int irq) | ||
| 210 | { | ||
| 211 | bcm1480_unmask_irq(bcm1480_irq_owner[irq], irq); | ||
| 212 | } | ||
| 213 | |||
| 214 | |||
| 215 | static void ack_bcm1480_irq(unsigned int irq) | ||
| 216 | { | ||
| 217 | u64 pending; | ||
| 218 | unsigned int irq_dirty; | ||
| 219 | |||
| 220 | /* | ||
| 221 | * If the interrupt was an HT interrupt, now is the time to | ||
| 222 | * clear it. NOTE: we assume the HT bridge was set up to | ||
| 223 | * deliver the interrupts to all CPUs (which makes affinity | ||
| 224 | * changing easier for us) | ||
| 225 | */ | ||
| 226 | irq_dirty = irq; | ||
| 227 | if ((irq_dirty >= BCM1480_NR_IRQS_HALF) && (irq_dirty <= BCM1480_NR_IRQS)) { | ||
| 228 | irq_dirty -= BCM1480_NR_IRQS_HALF; | ||
| 229 | } | ||
| 230 | int k; | ||
| 231 | for (k=0; k<2; k++) { /* Loop through high and low LDT interrupts */ | ||
| 232 | pending = __raw_readq(IOADDR(A_BCM1480_IMR_REGISTER(bcm1480_irq_owner[irq], | ||
| 233 | R_BCM1480_IMR_LDT_INTERRUPT_H + (k*BCM1480_IMR_HL_SPACING)))); | ||
| 234 | pending &= ((u64)1 << (irq_dirty)); | ||
| 235 | if (pending) { | ||
| 236 | #ifdef CONFIG_SMP | ||
| 237 | int i; | ||
| 238 | for (i=0; i<NR_CPUS; i++) { | ||
| 239 | /* | ||
| 240 | * Clear for all CPUs so an affinity switch | ||
| 241 | * doesn't find an old status | ||
| 242 | */ | ||
| 243 | __raw_writeq(pending, IOADDR(A_BCM1480_IMR_REGISTER(cpu_logical_map(i), | ||
| 244 | R_BCM1480_IMR_LDT_INTERRUPT_CLR_H + (k*BCM1480_IMR_HL_SPACING)))); | ||
| 245 | } | ||
| 246 | #else | ||
| 247 | __raw_writeq(pending, IOADDR(A_BCM1480_IMR_REGISTER(0, R_BCM1480_IMR_LDT_INTERRUPT_CLR_H + (k*BCM1480_IMR_HL_SPACING)))); | ||
| 248 | #endif | ||
| 249 | |||
| 250 | /* | ||
| 251 | * Generate EOI. For Pass 1 parts, EOI is a nop. For | ||
| 252 | * Pass 2, the LDT world may be edge-triggered, but | ||
| 253 | * this EOI shouldn't hurt. If they are | ||
| 254 | * level-sensitive, the EOI is required. | ||
| 255 | */ | ||
| 256 | #ifdef CONFIG_PCI | ||
| 257 | if (ht_eoi_space) | ||
| 258 | *(uint32_t *)(ht_eoi_space+(irq<<16)+(7<<2)) = 0; | ||
| 259 | #endif | ||
| 260 | } | ||
| 261 | } | ||
| 262 | bcm1480_mask_irq(bcm1480_irq_owner[irq], irq); | ||
| 263 | } | ||
| 264 | |||
| 265 | |||
| 266 | static void end_bcm1480_irq(unsigned int irq) | ||
| 267 | { | ||
| 268 | if (!(irq_desc[irq].status & (IRQ_DISABLED | IRQ_INPROGRESS))) { | ||
| 269 | bcm1480_unmask_irq(bcm1480_irq_owner[irq], irq); | ||
| 270 | } | ||
| 271 | } | ||
| 272 | |||
| 273 | |||
| 274 | void __init init_bcm1480_irqs(void) | ||
| 275 | { | ||
| 276 | int i; | ||
| 277 | |||
| 278 | for (i = 0; i < NR_IRQS; i++) { | ||
| 279 | irq_desc[i].status = IRQ_DISABLED; | ||
| 280 | irq_desc[i].action = 0; | ||
| 281 | irq_desc[i].depth = 1; | ||
| 282 | if (i < BCM1480_NR_IRQS) { | ||
| 283 | irq_desc[i].handler = &bcm1480_irq_type; | ||
| 284 | bcm1480_irq_owner[i] = 0; | ||
| 285 | } else { | ||
| 286 | irq_desc[i].handler = &no_irq_type; | ||
| 287 | } | ||
| 288 | } | ||
| 289 | } | ||
| 290 | |||
| 291 | |||
| 292 | static irqreturn_t bcm1480_dummy_handler(int irq, void *dev_id, | ||
| 293 | struct pt_regs *regs) | ||
| 294 | { | ||
| 295 | return IRQ_NONE; | ||
| 296 | } | ||
| 297 | |||
| 298 | static struct irqaction bcm1480_dummy_action = { | ||
| 299 | .handler = bcm1480_dummy_handler, | ||
| 300 | .flags = 0, | ||
| 301 | .mask = CPU_MASK_NONE, | ||
| 302 | .name = "bcm1480-private", | ||
| 303 | .next = NULL, | ||
| 304 | .dev_id = 0 | ||
| 305 | }; | ||
| 306 | |||
| 307 | int bcm1480_steal_irq(int irq) | ||
| 308 | { | ||
| 309 | irq_desc_t *desc = irq_desc + irq; | ||
| 310 | unsigned long flags; | ||
| 311 | int retval = 0; | ||
| 312 | |||
| 313 | if (irq >= BCM1480_NR_IRQS) | ||
| 314 | return -EINVAL; | ||
| 315 | |||
| 316 | spin_lock_irqsave(&desc->lock,flags); | ||
| 317 | /* Don't allow sharing at all for these */ | ||
| 318 | if (desc->action != NULL) | ||
| 319 | retval = -EBUSY; | ||
| 320 | else { | ||
| 321 | desc->action = &bcm1480_dummy_action; | ||
| 322 | desc->depth = 0; | ||
| 323 | } | ||
| 324 | spin_unlock_irqrestore(&desc->lock,flags); | ||
| 325 | return 0; | ||
| 326 | } | ||
| 327 | |||
| 328 | /* | ||
| 329 | * init_IRQ is called early in the boot sequence from init/main.c. It | ||
| 330 | * is responsible for setting up the interrupt mapper and installing the | ||
| 331 | * handler that will be responsible for dispatching interrupts to the | ||
| 332 | * "right" place. | ||
| 333 | */ | ||
| 334 | /* | ||
| 335 | * For now, map all interrupts to IP[2]. We could save | ||
| 336 | * some cycles by parceling out system interrupts to different | ||
| 337 | * IP lines, but keep it simple for bringup. We'll also direct | ||
| 338 | * all interrupts to a single CPU; we should probably route | ||
| 339 | * PCI and LDT to one cpu and everything else to the other | ||
| 340 | * to balance the load a bit. | ||
| 341 | * | ||
| 342 | * On the second cpu, everything is set to IP5, which is | ||
| 343 | * ignored, EXCEPT the mailbox interrupt. That one is | ||
| 344 | * set to IP[2] so it is handled. This is needed so we | ||
| 345 | * can do cross-cpu function calls, as requred by SMP | ||
| 346 | */ | ||
| 347 | |||
| 348 | #define IMR_IP2_VAL K_BCM1480_INT_MAP_I0 | ||
| 349 | #define IMR_IP3_VAL K_BCM1480_INT_MAP_I1 | ||
| 350 | #define IMR_IP4_VAL K_BCM1480_INT_MAP_I2 | ||
| 351 | #define IMR_IP5_VAL K_BCM1480_INT_MAP_I3 | ||
| 352 | #define IMR_IP6_VAL K_BCM1480_INT_MAP_I4 | ||
| 353 | |||
| 354 | void __init arch_init_irq(void) | ||
| 355 | { | ||
| 356 | |||
| 357 | unsigned int i, cpu; | ||
| 358 | u64 tmp; | ||
| 359 | unsigned int imask = STATUSF_IP4 | STATUSF_IP3 | STATUSF_IP2 | | ||
| 360 | STATUSF_IP1 | STATUSF_IP0; | ||
| 361 | |||
| 362 | /* Default everything to IP2 */ | ||
| 363 | /* Start with _high registers which has no bit 0 interrupt source */ | ||
| 364 | for (i = 1; i < BCM1480_NR_IRQS_HALF; i++) { /* was I0 */ | ||
| 365 | for (cpu = 0; cpu < 4; cpu++) { | ||
| 366 | __raw_writeq(IMR_IP2_VAL, | ||
| 367 | IOADDR(A_BCM1480_IMR_REGISTER(cpu, | ||
| 368 | R_BCM1480_IMR_INTERRUPT_MAP_BASE_H) + (i << 3))); | ||
| 369 | } | ||
| 370 | } | ||
| 371 | |||
| 372 | /* Now do _low registers */ | ||
| 373 | for (i = 0; i < BCM1480_NR_IRQS_HALF; i++) { | ||
| 374 | for (cpu = 0; cpu < 4; cpu++) { | ||
| 375 | __raw_writeq(IMR_IP2_VAL, | ||
| 376 | IOADDR(A_BCM1480_IMR_REGISTER(cpu, | ||
| 377 | R_BCM1480_IMR_INTERRUPT_MAP_BASE_L) + (i << 3))); | ||
| 378 | } | ||
| 379 | } | ||
| 380 | |||
| 381 | init_bcm1480_irqs(); | ||
| 382 | |||
| 383 | /* | ||
| 384 | * Map the high 16 bits of mailbox_0 registers to IP[3], for | ||
| 385 | * inter-cpu messages | ||
| 386 | */ | ||
| 387 | /* Was I1 */ | ||
| 388 | for (cpu = 0; cpu < 4; cpu++) { | ||
| 389 | __raw_writeq(IMR_IP3_VAL, IOADDR(A_BCM1480_IMR_REGISTER(cpu, R_BCM1480_IMR_INTERRUPT_MAP_BASE_H) + | ||
| 390 | (K_BCM1480_INT_MBOX_0_0 << 3))); | ||
| 391 | } | ||
| 392 | |||
| 393 | |||
| 394 | /* Clear the mailboxes. The firmware may leave them dirty */ | ||
| 395 | for (cpu = 0; cpu < 4; cpu++) { | ||
| 396 | __raw_writeq(0xffffffffffffffffULL, | ||
| 397 | IOADDR(A_BCM1480_IMR_REGISTER(cpu, R_BCM1480_IMR_MAILBOX_0_CLR_CPU))); | ||
| 398 | __raw_writeq(0xffffffffffffffffULL, | ||
| 399 | IOADDR(A_BCM1480_IMR_REGISTER(cpu, R_BCM1480_IMR_MAILBOX_1_CLR_CPU))); | ||
| 400 | } | ||
| 401 | |||
| 402 | |||
| 403 | /* Mask everything except the high 16 bit of mailbox_0 registers for all cpus */ | ||
| 404 | tmp = ~((u64) 0) ^ ( (((u64) 1) << K_BCM1480_INT_MBOX_0_0)); | ||
| 405 | for (cpu = 0; cpu < 4; cpu++) { | ||
| 406 | __raw_writeq(tmp, IOADDR(A_BCM1480_IMR_REGISTER(cpu, R_BCM1480_IMR_INTERRUPT_MASK_H))); | ||
| 407 | } | ||
| 408 | tmp = ~((u64) 0); | ||
| 409 | for (cpu = 0; cpu < 4; cpu++) { | ||
| 410 | __raw_writeq(tmp, IOADDR(A_BCM1480_IMR_REGISTER(cpu, R_BCM1480_IMR_INTERRUPT_MASK_L))); | ||
| 411 | } | ||
| 412 | |||
| 413 | bcm1480_steal_irq(K_BCM1480_INT_MBOX_0_0); | ||
| 414 | |||
| 415 | /* | ||
| 416 | * Note that the timer interrupts are also mapped, but this is | ||
| 417 | * done in bcm1480_time_init(). Also, the profiling driver | ||
| 418 | * does its own management of IP7. | ||
| 419 | */ | ||
| 420 | |||
| 421 | #ifdef CONFIG_KGDB | ||
| 422 | imask |= STATUSF_IP6; | ||
| 423 | #endif | ||
| 424 | /* Enable necessary IPs, disable the rest */ | ||
| 425 | change_c0_status(ST0_IM, imask); | ||
| 426 | set_except_vector(0, bcm1480_irq_handler); | ||
| 427 | |||
| 428 | #ifdef CONFIG_KGDB | ||
| 429 | if (kgdb_flag) { | ||
| 430 | kgdb_irq = K_BCM1480_INT_UART_0 + kgdb_port; | ||
| 431 | |||
| 432 | #ifdef CONFIG_SIBYTE_SB1250_DUART | ||
| 433 | sb1250_duart_present[kgdb_port] = 0; | ||
| 434 | #endif | ||
| 435 | /* Setup uart 1 settings, mapper */ | ||
| 436 | /* QQQ FIXME */ | ||
| 437 | __raw_writeq(M_DUART_IMR_BRK, IO_SPACE_BASE + A_DUART_IMRREG(kgdb_port)); | ||
| 438 | |||
| 439 | bcm1480_steal_irq(kgdb_irq); | ||
| 440 | __raw_writeq(IMR_IP6_VAL, | ||
| 441 | IO_SPACE_BASE + A_BCM1480_IMR_REGISTER(0, R_BCM1480_IMR_INTERRUPT_MAP_BASE_H) + | ||
| 442 | (kgdb_irq<<3)); | ||
| 443 | bcm1480_unmask_irq(0, kgdb_irq); | ||
| 444 | |||
| 445 | #ifdef CONFIG_GDB_CONSOLE | ||
| 446 | register_gdb_console(); | ||
| 447 | #endif | ||
| 448 | prom_printf("Waiting for GDB on UART port %d\n", kgdb_port); | ||
| 449 | set_debug_traps(); | ||
| 450 | breakpoint(); | ||
| 451 | } | ||
| 452 | #endif | ||
| 453 | } | ||
| 454 | |||
| 455 | #ifdef CONFIG_KGDB | ||
| 456 | |||
| 457 | #include <linux/delay.h> | ||
| 458 | |||
| 459 | #define duart_out(reg, val) csr_out32(val, IOADDR(A_DUART_CHANREG(kgdb_port,reg))) | ||
| 460 | #define duart_in(reg) csr_in32(IOADDR(A_DUART_CHANREG(kgdb_port,reg))) | ||
| 461 | |||
| 462 | void bcm1480_kgdb_interrupt(struct pt_regs *regs) | ||
| 463 | { | ||
| 464 | /* | ||
| 465 | * Clear break-change status (allow some time for the remote | ||
| 466 | * host to stop the break, since we would see another | ||
| 467 | * interrupt on the end-of-break too) | ||
| 468 | */ | ||
| 469 | kstat.irqs[smp_processor_id()][kgdb_irq]++; | ||
| 470 | mdelay(500); | ||
| 471 | duart_out(R_DUART_CMD, V_DUART_MISC_CMD_RESET_BREAK_INT | | ||
| 472 | M_DUART_RX_EN | M_DUART_TX_EN); | ||
| 473 | set_async_breakpoint(®s->cp0_epc); | ||
| 474 | } | ||
| 475 | |||
| 476 | #endif /* CONFIG_KGDB */ | ||
diff --git a/arch/mips/sibyte/bcm1480/irq_handler.S b/arch/mips/sibyte/bcm1480/irq_handler.S new file mode 100644 index 000000000000..408db88d050f --- /dev/null +++ b/arch/mips/sibyte/bcm1480/irq_handler.S | |||
| @@ -0,0 +1,165 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (C) 2000,2001,2002,2003,2004 Broadcom Corporation | ||
| 3 | * | ||
| 4 | * This program is free software; you can redistribute it and/or | ||
| 5 | * modify it under the terms of the GNU General Public License | ||
| 6 | * as published by the Free Software Foundation; either version 2 | ||
| 7 | * of the License, or (at your option) any later version. | ||
| 8 | * | ||
| 9 | * This program is distributed in the hope that it will be useful, | ||
| 10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 12 | * GNU General Public License for more details. | ||
| 13 | * | ||
| 14 | * You should have received a copy of the GNU General Public License | ||
| 15 | * along with this program; if not, write to the Free Software | ||
| 16 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | ||
| 17 | */ | ||
| 18 | |||
| 19 | /* | ||
| 20 | * bcm1480_irq_handler() is the routine that is actually called when an | ||
| 21 | * interrupt occurs. It is installed as the exception vector handler in | ||
| 22 | * init_IRQ() in arch/mips/sibyte/bcm1480/irq.c | ||
| 23 | * | ||
| 24 | * In the handle we figure out which interrupts need handling, and use that | ||
| 25 | * to call the dispatcher, which will take care of actually calling | ||
| 26 | * registered handlers | ||
| 27 | * | ||
| 28 | * Note that we take care of all raised interrupts in one go at the handler. | ||
| 29 | * This is more BSDish than the Indy code, and also, IMHO, more sane. | ||
| 30 | */ | ||
| 31 | #include <linux/config.h> | ||
| 32 | |||
| 33 | #include <asm/addrspace.h> | ||
| 34 | #include <asm/asm.h> | ||
| 35 | #include <asm/mipsregs.h> | ||
| 36 | #include <asm/regdef.h> | ||
| 37 | #include <asm/stackframe.h> | ||
| 38 | #include <asm/sibyte/sb1250_defs.h> | ||
| 39 | #include <asm/sibyte/bcm1480_regs.h> | ||
| 40 | #include <asm/sibyte/bcm1480_int.h> | ||
| 41 | |||
| 42 | /* | ||
| 43 | * What a pain. We have to be really careful saving the upper 32 bits of any | ||
| 44 | * register across function calls if we don't want them trashed--since were | ||
| 45 | * running in -o32, the calling routing never saves the full 64 bits of a | ||
| 46 | * register across a function call. Being the interrupt handler, we're | ||
| 47 | * guaranteed that interrupts are disabled during this code so we don't have | ||
| 48 | * to worry about random interrupts blasting the high 32 bits. | ||
| 49 | */ | ||
| 50 | |||
| 51 | .text | ||
| 52 | .set push | ||
| 53 | .set noreorder | ||
| 54 | .set noat | ||
| 55 | .set mips64 | ||
| 56 | #.set mips4 | ||
| 57 | .align 5 | ||
| 58 | NESTED(bcm1480_irq_handler, PT_SIZE, sp) | ||
| 59 | SAVE_ALL | ||
| 60 | CLI | ||
| 61 | |||
| 62 | #ifdef CONFIG_SIBYTE_BCM1480_PROF | ||
| 63 | /* Set compare to count to silence count/compare timer interrupts */ | ||
| 64 | mfc0 t1, CP0_COUNT | ||
| 65 | mtc0 t1, CP0_COMPARE /* pause to clear IP[7] bit of cause ? */ | ||
| 66 | #endif | ||
| 67 | /* Read cause */ | ||
| 68 | mfc0 s0, CP0_CAUSE | ||
| 69 | |||
| 70 | #ifdef CONFIG_SIBYTE_BCM1480_PROF | ||
| 71 | /* Cpu performance counter interrupt is routed to IP[7] */ | ||
| 72 | andi t1, s0, CAUSEF_IP7 | ||
| 73 | beqz t1, 0f | ||
| 74 | srl t1, s0, (CAUSEB_BD-2) /* Shift BD bit to bit 2 */ | ||
| 75 | and t1, t1, 0x4 /* mask to get just BD bit */ | ||
| 76 | #ifdef CONFIG_MIPS64 | ||
| 77 | dmfc0 a0, CP0_EPC | ||
| 78 | daddu a0, a0, t1 /* a0 = EPC + (BD ? 4 : 0) */ | ||
| 79 | #else | ||
| 80 | mfc0 a0, CP0_EPC | ||
| 81 | addu a0, a0, t1 /* a0 = EPC + (BD ? 4 : 0) */ | ||
| 82 | #endif | ||
| 83 | jal sbprof_cpu_intr | ||
| 84 | nop | ||
| 85 | j ret_from_irq | ||
| 86 | nop | ||
| 87 | 0: | ||
| 88 | #endif | ||
| 89 | |||
| 90 | /* Timer interrupt is routed to IP[4] */ | ||
| 91 | andi t1, s0, CAUSEF_IP4 | ||
| 92 | beqz t1, 1f | ||
| 93 | nop | ||
| 94 | jal bcm1480_timer_interrupt | ||
| 95 | move a0, sp /* Pass the registers along */ | ||
| 96 | j ret_from_irq | ||
| 97 | nop /* delay slot */ | ||
| 98 | 1: | ||
| 99 | |||
| 100 | #ifdef CONFIG_SMP | ||
| 101 | /* Mailbox interrupt is routed to IP[3] */ | ||
| 102 | andi t1, s0, CAUSEF_IP3 | ||
| 103 | beqz t1, 2f | ||
| 104 | nop | ||
| 105 | jal bcm1480_mailbox_interrupt | ||
| 106 | move a0, sp | ||
| 107 | j ret_from_irq | ||
| 108 | nop /* delay slot */ | ||
| 109 | 2: | ||
| 110 | #endif | ||
| 111 | |||
| 112 | #ifdef CONFIG_KGDB | ||
| 113 | /* KGDB (uart 1) interrupt is routed to IP[6] */ | ||
| 114 | andi t1, s0, CAUSEF_IP6 | ||
| 115 | beqz t1, 3f | ||
| 116 | nop /* delay slot */ | ||
| 117 | jal bcm1480_kgdb_interrupt | ||
| 118 | move a0, sp | ||
| 119 | j ret_from_irq | ||
| 120 | nop /* delay slot */ | ||
| 121 | 3: | ||
| 122 | #endif | ||
| 123 | |||
| 124 | and t1, s0, CAUSEF_IP2 | ||
| 125 | beqz t1, 9f | ||
| 126 | nop | ||
| 127 | |||
| 128 | /* | ||
| 129 | * Default...we've hit an IP[2] interrupt, which means we've got | ||
| 130 | * to check the 1480 interrupt registers to figure out what to do | ||
| 131 | * Need to detect which CPU we're on, now that smp_affinity is | ||
| 132 | * supported. | ||
| 133 | */ | ||
| 134 | PTR_LA v0, CKSEG1 + A_BCM1480_IMR_CPU0_BASE | ||
| 135 | #ifdef CONFIG_SMP | ||
| 136 | lw t1, TI_CPU($28) | ||
| 137 | sll t1, t1, BCM1480_IMR_REGISTER_SPACING_SHIFT | ||
| 138 | addu v0, v0, t1 | ||
| 139 | #endif | ||
| 140 | |||
| 141 | /* Read IP[2] status (get both high and low halves of status) */ | ||
| 142 | ld s0, R_BCM1480_IMR_INTERRUPT_STATUS_BASE_H(v0) | ||
| 143 | ld s1, R_BCM1480_IMR_INTERRUPT_STATUS_BASE_L(v0) | ||
| 144 | |||
| 145 | move s2, zero /* intr number */ | ||
| 146 | li s3, 64 | ||
| 147 | |||
| 148 | beqz s0, 9f /* No interrupts. Return. */ | ||
| 149 | move a1, sp | ||
| 150 | |||
| 151 | xori s4, s0, 1 /* if s0 (_H) == 1, it's a low intr, so... */ | ||
| 152 | movz s2, s3, s4 /* start the intr number at 64, and */ | ||
| 153 | movz s0, s1, s4 /* look at the low status value. */ | ||
| 154 | |||
| 155 | dclz s1, s0 /* Find the next interrupt. */ | ||
| 156 | dsubu a0, zero, s1 | ||
| 157 | daddiu a0, a0, 63 | ||
| 158 | jal do_IRQ | ||
| 159 | daddu a0, a0, s2 | ||
| 160 | |||
| 161 | 9: j ret_from_irq | ||
| 162 | nop | ||
| 163 | |||
| 164 | .set pop | ||
| 165 | END(bcm1480_irq_handler) | ||
diff --git a/arch/mips/sibyte/bcm1480/setup.c b/arch/mips/sibyte/bcm1480/setup.c new file mode 100644 index 000000000000..d90a0b87874c --- /dev/null +++ b/arch/mips/sibyte/bcm1480/setup.c | |||
| @@ -0,0 +1,136 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (C) 2000,2001,2002,2003,2004 Broadcom Corporation | ||
| 3 | * | ||
| 4 | * This program is free software; you can redistribute it and/or | ||
| 5 | * modify it under the terms of the GNU General Public License | ||
| 6 | * as published by the Free Software Foundation; either version 2 | ||
| 7 | * of the License, or (at your option) any later version. | ||
| 8 | * | ||
| 9 | * This program is distributed in the hope that it will be useful, | ||
| 10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 12 | * GNU General Public License for more details. | ||
| 13 | * | ||
| 14 | * You should have received a copy of the GNU General Public License | ||
| 15 | * along with this program; if not, write to the Free Software | ||
| 16 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | ||
| 17 | */ | ||
| 18 | #include <linux/config.h> | ||
| 19 | #include <linux/kernel.h> | ||
| 20 | #include <linux/reboot.h> | ||
| 21 | #include <linux/string.h> | ||
| 22 | |||
| 23 | #include <asm/bootinfo.h> | ||
| 24 | #include <asm/mipsregs.h> | ||
| 25 | #include <asm/io.h> | ||
| 26 | #include <asm/sibyte/sb1250.h> | ||
| 27 | |||
| 28 | #include <asm/sibyte/bcm1480_regs.h> | ||
| 29 | #include <asm/sibyte/bcm1480_scd.h> | ||
| 30 | #include <asm/sibyte/sb1250_scd.h> | ||
| 31 | |||
| 32 | unsigned int sb1_pass; | ||
| 33 | unsigned int soc_pass; | ||
| 34 | unsigned int soc_type; | ||
| 35 | unsigned int periph_rev; | ||
| 36 | unsigned int zbbus_mhz; | ||
| 37 | |||
| 38 | static unsigned int part_type; | ||
| 39 | |||
| 40 | static char *soc_str; | ||
| 41 | static char *pass_str; | ||
| 42 | |||
| 43 | static inline int setup_bcm1x80_bcm1x55(void); | ||
| 44 | |||
| 45 | /* Setup code likely to be common to all SiByte platforms */ | ||
| 46 | |||
| 47 | static inline int sys_rev_decode(void) | ||
| 48 | { | ||
| 49 | int ret = 0; | ||
| 50 | |||
| 51 | switch (soc_type) { | ||
| 52 | case K_SYS_SOC_TYPE_BCM1x80: | ||
| 53 | if (part_type == K_SYS_PART_BCM1480) | ||
| 54 | soc_str = "BCM1480"; | ||
| 55 | else if (part_type == K_SYS_PART_BCM1280) | ||
| 56 | soc_str = "BCM1280"; | ||
| 57 | else | ||
| 58 | soc_str = "BCM1x80"; | ||
| 59 | ret = setup_bcm1x80_bcm1x55(); | ||
| 60 | break; | ||
| 61 | |||
| 62 | case K_SYS_SOC_TYPE_BCM1x55: | ||
| 63 | if (part_type == K_SYS_PART_BCM1455) | ||
| 64 | soc_str = "BCM1455"; | ||
| 65 | else if (part_type == K_SYS_PART_BCM1255) | ||
| 66 | soc_str = "BCM1255"; | ||
| 67 | else | ||
| 68 | soc_str = "BCM1x55"; | ||
| 69 | ret = setup_bcm1x80_bcm1x55(); | ||
| 70 | break; | ||
| 71 | |||
| 72 | default: | ||
| 73 | prom_printf("Unknown part type %x\n", part_type); | ||
| 74 | ret = 1; | ||
| 75 | break; | ||
| 76 | } | ||
| 77 | return ret; | ||
| 78 | } | ||
| 79 | |||
| 80 | static inline int setup_bcm1x80_bcm1x55(void) | ||
| 81 | { | ||
| 82 | int ret = 0; | ||
| 83 | |||
| 84 | switch (soc_pass) { | ||
| 85 | case K_SYS_REVISION_BCM1480_S0: | ||
| 86 | periph_rev = 1; | ||
| 87 | pass_str = "S0 (pass1)"; | ||
| 88 | break; | ||
| 89 | case K_SYS_REVISION_BCM1480_A1: | ||
| 90 | periph_rev = 1; | ||
| 91 | pass_str = "A1 (pass1)"; | ||
| 92 | break; | ||
| 93 | case K_SYS_REVISION_BCM1480_A2: | ||
| 94 | periph_rev = 1; | ||
| 95 | pass_str = "A2 (pass1)"; | ||
| 96 | break; | ||
| 97 | case K_SYS_REVISION_BCM1480_A3: | ||
| 98 | periph_rev = 1; | ||
| 99 | pass_str = "A3 (pass1)"; | ||
| 100 | break; | ||
| 101 | case K_SYS_REVISION_BCM1480_B0: | ||
| 102 | periph_rev = 1; | ||
| 103 | pass_str = "B0 (pass2)"; | ||
| 104 | break; | ||
| 105 | default: | ||
| 106 | prom_printf("Unknown %s rev %x\n", soc_str, soc_pass); | ||
| 107 | periph_rev = 1; | ||
| 108 | pass_str = "Unknown Revision"; | ||
| 109 | break; | ||
| 110 | } | ||
| 111 | return ret; | ||
| 112 | } | ||
| 113 | |||
| 114 | void bcm1480_setup(void) | ||
| 115 | { | ||
| 116 | uint64_t sys_rev; | ||
| 117 | int plldiv; | ||
| 118 | |||
| 119 | sb1_pass = read_c0_prid() & 0xff; | ||
| 120 | sys_rev = __raw_readq(IOADDR(A_SCD_SYSTEM_REVISION)); | ||
| 121 | soc_type = SYS_SOC_TYPE(sys_rev); | ||
| 122 | part_type = G_SYS_PART(sys_rev); | ||
| 123 | soc_pass = G_SYS_REVISION(sys_rev); | ||
| 124 | |||
| 125 | if (sys_rev_decode()) { | ||
| 126 | prom_printf("Restart after failure to identify SiByte chip\n"); | ||
| 127 | machine_restart(NULL); | ||
| 128 | } | ||
| 129 | |||
| 130 | plldiv = G_BCM1480_SYS_PLL_DIV(__raw_readq(IOADDR(A_SCD_SYSTEM_CFG))); | ||
| 131 | zbbus_mhz = ((plldiv >> 1) * 50) + ((plldiv & 1) * 25); | ||
| 132 | |||
| 133 | prom_printf("Broadcom SiByte %s %s @ %d MHz (SB-1A rev %d)\n", | ||
| 134 | soc_str, pass_str, zbbus_mhz * 2, sb1_pass); | ||
| 135 | prom_printf("Board type: %s\n", get_system_type()); | ||
| 136 | } | ||
diff --git a/arch/mips/sibyte/bcm1480/smp.c b/arch/mips/sibyte/bcm1480/smp.c new file mode 100644 index 000000000000..584a4b33faac --- /dev/null +++ b/arch/mips/sibyte/bcm1480/smp.c | |||
| @@ -0,0 +1,110 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (C) 2001,2002,2004 Broadcom Corporation | ||
| 3 | * | ||
| 4 | * This program is free software; you can redistribute it and/or | ||
| 5 | * modify it under the terms of the GNU General Public License | ||
| 6 | * as published by the Free Software Foundation; either version 2 | ||
| 7 | * of the License, or (at your option) any later version. | ||
| 8 | * | ||
| 9 | * This program is distributed in the hope that it will be useful, | ||
| 10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 12 | * GNU General Public License for more details. | ||
| 13 | * | ||
| 14 | * You should have received a copy of the GNU General Public License | ||
| 15 | * along with this program; if not, write to the Free Software | ||
| 16 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | ||
| 17 | */ | ||
| 18 | |||
| 19 | #include <linux/init.h> | ||
| 20 | #include <linux/delay.h> | ||
| 21 | #include <linux/smp.h> | ||
| 22 | #include <linux/kernel_stat.h> | ||
| 23 | |||
| 24 | #include <asm/mmu_context.h> | ||
| 25 | #include <asm/io.h> | ||
| 26 | #include <asm/sibyte/sb1250.h> | ||
| 27 | #include <asm/sibyte/bcm1480_regs.h> | ||
| 28 | #include <asm/sibyte/bcm1480_int.h> | ||
| 29 | |||
| 30 | extern void smp_call_function_interrupt(void); | ||
| 31 | |||
| 32 | /* | ||
| 33 | * These are routines for dealing with the bcm1480 smp capabilities | ||
| 34 | * independent of board/firmware | ||
| 35 | */ | ||
| 36 | |||
| 37 | static void *mailbox_0_set_regs[] = { | ||
| 38 | IOADDR(A_BCM1480_IMR_CPU0_BASE + R_BCM1480_IMR_MAILBOX_0_SET_CPU), | ||
| 39 | IOADDR(A_BCM1480_IMR_CPU1_BASE + R_BCM1480_IMR_MAILBOX_0_SET_CPU), | ||
| 40 | IOADDR(A_BCM1480_IMR_CPU2_BASE + R_BCM1480_IMR_MAILBOX_0_SET_CPU), | ||
| 41 | IOADDR(A_BCM1480_IMR_CPU3_BASE + R_BCM1480_IMR_MAILBOX_0_SET_CPU), | ||
| 42 | }; | ||
| 43 | |||
| 44 | static void *mailbox_0_clear_regs[] = { | ||
| 45 | IOADDR(A_BCM1480_IMR_CPU0_BASE + R_BCM1480_IMR_MAILBOX_0_CLR_CPU), | ||
| 46 | IOADDR(A_BCM1480_IMR_CPU1_BASE + R_BCM1480_IMR_MAILBOX_0_CLR_CPU), | ||
| 47 | IOADDR(A_BCM1480_IMR_CPU2_BASE + R_BCM1480_IMR_MAILBOX_0_CLR_CPU), | ||
| 48 | IOADDR(A_BCM1480_IMR_CPU3_BASE + R_BCM1480_IMR_MAILBOX_0_CLR_CPU), | ||
| 49 | }; | ||
| 50 | |||
| 51 | static void *mailbox_0_regs[] = { | ||
| 52 | IOADDR(A_BCM1480_IMR_CPU0_BASE + R_BCM1480_IMR_MAILBOX_0_CPU), | ||
| 53 | IOADDR(A_BCM1480_IMR_CPU1_BASE + R_BCM1480_IMR_MAILBOX_0_CPU), | ||
| 54 | IOADDR(A_BCM1480_IMR_CPU2_BASE + R_BCM1480_IMR_MAILBOX_0_CPU), | ||
| 55 | IOADDR(A_BCM1480_IMR_CPU3_BASE + R_BCM1480_IMR_MAILBOX_0_CPU), | ||
| 56 | }; | ||
| 57 | |||
| 58 | /* | ||
| 59 | * SMP init and finish on secondary CPUs | ||
| 60 | */ | ||
| 61 | void bcm1480_smp_init(void) | ||
| 62 | { | ||
| 63 | unsigned int imask = STATUSF_IP4 | STATUSF_IP3 | STATUSF_IP2 | | ||
| 64 | STATUSF_IP1 | STATUSF_IP0; | ||
| 65 | |||
| 66 | /* Set interrupt mask, but don't enable */ | ||
| 67 | change_c0_status(ST0_IM, imask); | ||
| 68 | } | ||
| 69 | |||
| 70 | void bcm1480_smp_finish(void) | ||
| 71 | { | ||
| 72 | extern void bcm1480_time_init(void); | ||
| 73 | bcm1480_time_init(); | ||
| 74 | local_irq_enable(); | ||
| 75 | } | ||
| 76 | |||
| 77 | /* | ||
| 78 | * These are routines for dealing with the sb1250 smp capabilities | ||
| 79 | * independent of board/firmware | ||
| 80 | */ | ||
| 81 | |||
| 82 | /* | ||
| 83 | * Simple enough; everything is set up, so just poke the appropriate mailbox | ||
| 84 | * register, and we should be set | ||
| 85 | */ | ||
| 86 | void core_send_ipi(int cpu, unsigned int action) | ||
| 87 | { | ||
| 88 | __raw_writeq((((u64)action)<< 48), mailbox_0_set_regs[cpu]); | ||
| 89 | } | ||
| 90 | |||
| 91 | void bcm1480_mailbox_interrupt(struct pt_regs *regs) | ||
| 92 | { | ||
| 93 | int cpu = smp_processor_id(); | ||
| 94 | unsigned int action; | ||
| 95 | |||
| 96 | kstat_this_cpu.irqs[K_BCM1480_INT_MBOX_0_0]++; | ||
| 97 | /* Load the mailbox register to figure out what we're supposed to do */ | ||
| 98 | action = (__raw_readq(mailbox_0_regs[cpu]) >> 48) & 0xffff; | ||
| 99 | |||
| 100 | /* Clear the mailbox to clear the interrupt */ | ||
| 101 | __raw_writeq(((u64)action)<<48, mailbox_0_clear_regs[cpu]); | ||
| 102 | |||
| 103 | /* | ||
| 104 | * Nothing to do for SMP_RESCHEDULE_YOURSELF; returning from the | ||
| 105 | * interrupt will do the reschedule for us | ||
| 106 | */ | ||
| 107 | |||
| 108 | if (action & SMP_CALL_FUNCTION) | ||
| 109 | smp_call_function_interrupt(); | ||
| 110 | } | ||
diff --git a/arch/mips/sibyte/bcm1480/time.c b/arch/mips/sibyte/bcm1480/time.c new file mode 100644 index 000000000000..e545752695a1 --- /dev/null +++ b/arch/mips/sibyte/bcm1480/time.c | |||
| @@ -0,0 +1,138 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (C) 2000,2001,2004 Broadcom Corporation | ||
| 3 | * | ||
| 4 | * This program is free software; you can redistribute it and/or | ||
| 5 | * modify it under the terms of the GNU General Public License | ||
| 6 | * as published by the Free Software Foundation; either version 2 | ||
| 7 | * of the License, or (at your option) any later version. | ||
| 8 | * | ||
| 9 | * This program is distributed in the hope that it will be useful, | ||
| 10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 12 | * GNU General Public License for more details. | ||
| 13 | * | ||
| 14 | * You should have received a copy of the GNU General Public License | ||
| 15 | * along with this program; if not, write to the Free Software | ||
| 16 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | ||
| 17 | */ | ||
| 18 | |||
| 19 | /* | ||
| 20 | * These are routines to set up and handle interrupts from the | ||
| 21 | * bcm1480 general purpose timer 0. We're using the timer as a | ||
| 22 | * system clock, so we set it up to run at 100 Hz. On every | ||
| 23 | * interrupt, we update our idea of what the time of day is, | ||
| 24 | * then call do_timer() in the architecture-independent kernel | ||
| 25 | * code to do general bookkeeping (e.g. update jiffies, run | ||
| 26 | * bottom halves, etc.) | ||
| 27 | */ | ||
| 28 | #include <linux/config.h> | ||
| 29 | #include <linux/interrupt.h> | ||
| 30 | #include <linux/sched.h> | ||
| 31 | #include <linux/spinlock.h> | ||
| 32 | #include <linux/kernel_stat.h> | ||
| 33 | |||
| 34 | #include <asm/irq.h> | ||
| 35 | #include <asm/ptrace.h> | ||
| 36 | #include <asm/addrspace.h> | ||
| 37 | #include <asm/time.h> | ||
| 38 | #include <asm/io.h> | ||
| 39 | |||
| 40 | #include <asm/sibyte/bcm1480_regs.h> | ||
| 41 | #include <asm/sibyte/sb1250_regs.h> | ||
| 42 | #include <asm/sibyte/bcm1480_int.h> | ||
| 43 | #include <asm/sibyte/bcm1480_scd.h> | ||
| 44 | |||
| 45 | #include <asm/sibyte/sb1250.h> | ||
| 46 | |||
| 47 | |||
| 48 | #define IMR_IP2_VAL K_BCM1480_INT_MAP_I0 | ||
| 49 | #define IMR_IP3_VAL K_BCM1480_INT_MAP_I1 | ||
| 50 | #define IMR_IP4_VAL K_BCM1480_INT_MAP_I2 | ||
| 51 | |||
| 52 | extern int bcm1480_steal_irq(int irq); | ||
| 53 | |||
| 54 | void bcm1480_time_init(void) | ||
| 55 | { | ||
| 56 | int cpu = smp_processor_id(); | ||
| 57 | int irq = K_BCM1480_INT_TIMER_0+cpu; | ||
| 58 | |||
| 59 | /* Only have 4 general purpose timers */ | ||
| 60 | if (cpu > 3) { | ||
| 61 | BUG(); | ||
| 62 | } | ||
| 63 | |||
| 64 | if (!cpu) { | ||
| 65 | /* Use our own gettimeoffset() routine */ | ||
| 66 | do_gettimeoffset = bcm1480_gettimeoffset; | ||
| 67 | } | ||
| 68 | |||
| 69 | bcm1480_mask_irq(cpu, irq); | ||
| 70 | |||
| 71 | /* Map the timer interrupt to ip[4] of this cpu */ | ||
| 72 | __raw_writeq(IMR_IP4_VAL, IOADDR(A_BCM1480_IMR_REGISTER(cpu, R_BCM1480_IMR_INTERRUPT_MAP_BASE_H) | ||
| 73 | + (irq<<3))); | ||
| 74 | |||
| 75 | /* the general purpose timer ticks at 1 Mhz independent of the rest of the system */ | ||
| 76 | /* Disable the timer and set up the count */ | ||
| 77 | __raw_writeq(0, IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_CFG))); | ||
| 78 | __raw_writeq( | ||
| 79 | #ifndef CONFIG_SIMULATION | ||
| 80 | 1000000/HZ | ||
| 81 | #else | ||
| 82 | 50000/HZ | ||
| 83 | #endif | ||
| 84 | , IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_INIT))); | ||
| 85 | |||
| 86 | /* Set the timer running */ | ||
| 87 | __raw_writeq(M_SCD_TIMER_ENABLE|M_SCD_TIMER_MODE_CONTINUOUS, | ||
| 88 | IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_CFG))); | ||
| 89 | |||
| 90 | bcm1480_unmask_irq(cpu, irq); | ||
| 91 | bcm1480_steal_irq(irq); | ||
| 92 | /* | ||
| 93 | * This interrupt is "special" in that it doesn't use the request_irq | ||
| 94 | * way to hook the irq line. The timer interrupt is initialized early | ||
| 95 | * enough to make this a major pain, and it's also firing enough to | ||
| 96 | * warrant a bit of special case code. bcm1480_timer_interrupt is | ||
| 97 | * called directly from irq_handler.S when IP[4] is set during an | ||
| 98 | * interrupt | ||
| 99 | */ | ||
| 100 | } | ||
| 101 | |||
| 102 | #include <asm/sibyte/sb1250.h> | ||
| 103 | |||
| 104 | void bcm1480_timer_interrupt(struct pt_regs *regs) | ||
| 105 | { | ||
| 106 | int cpu = smp_processor_id(); | ||
| 107 | int irq = K_BCM1480_INT_TIMER_0+cpu; | ||
| 108 | |||
| 109 | /* Reset the timer */ | ||
| 110 | __raw_writeq(M_SCD_TIMER_ENABLE|M_SCD_TIMER_MODE_CONTINUOUS, | ||
| 111 | IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_CFG))); | ||
| 112 | |||
| 113 | /* | ||
| 114 | * CPU 0 handles the global timer interrupt job | ||
| 115 | */ | ||
| 116 | if (cpu == 0) { | ||
| 117 | ll_timer_interrupt(irq, regs); | ||
| 118 | } | ||
| 119 | |||
| 120 | /* | ||
| 121 | * every CPU should do profiling and process accouting | ||
| 122 | */ | ||
| 123 | ll_local_timer_interrupt(irq, regs); | ||
| 124 | } | ||
| 125 | |||
| 126 | /* | ||
| 127 | * We use our own do_gettimeoffset() instead of the generic one, | ||
| 128 | * because the generic one does not work for SMP case. | ||
| 129 | * In addition, since we use general timer 0 for system time, | ||
| 130 | * we can get accurate intra-jiffy offset without calibration. | ||
| 131 | */ | ||
| 132 | unsigned long bcm1480_gettimeoffset(void) | ||
| 133 | { | ||
| 134 | unsigned long count = | ||
| 135 | __raw_readq(IOADDR(A_SCD_TIMER_REGISTER(0, R_SCD_TIMER_CNT))); | ||
| 136 | |||
| 137 | return 1000000/HZ - count; | ||
| 138 | } | ||
diff --git a/arch/mips/sibyte/cfe/smp.c b/arch/mips/sibyte/cfe/smp.c index e44ce1a9eea9..e8485124b8fc 100644 --- a/arch/mips/sibyte/cfe/smp.c +++ b/arch/mips/sibyte/cfe/smp.c | |||
| @@ -70,8 +70,15 @@ void prom_boot_secondary(int cpu, struct task_struct *idle) | |||
| 70 | */ | 70 | */ |
| 71 | void prom_init_secondary(void) | 71 | void prom_init_secondary(void) |
| 72 | { | 72 | { |
| 73 | #if defined(CONFIG_SIBYTE_BCM1x55) || defined(CONFIG_SIBYTE_BCM1x80) | ||
| 74 | extern void bcm1480_smp_init(void); | ||
| 75 | bcm1480_smp_init(); | ||
| 76 | #elif defined(CONFIG_SIBYTE_SB1250) | ||
| 73 | extern void sb1250_smp_init(void); | 77 | extern void sb1250_smp_init(void); |
| 74 | sb1250_smp_init(); | 78 | sb1250_smp_init(); |
| 79 | #else | ||
| 80 | #error invalid SMP configuration | ||
| 81 | #endif | ||
| 75 | } | 82 | } |
| 76 | 83 | ||
| 77 | /* | 84 | /* |
| @@ -80,8 +87,15 @@ void prom_init_secondary(void) | |||
| 80 | */ | 87 | */ |
| 81 | void prom_smp_finish(void) | 88 | void prom_smp_finish(void) |
| 82 | { | 89 | { |
| 90 | #if defined(CONFIG_SIBYTE_BCM1x55) || defined(CONFIG_SIBYTE_BCM1x80) | ||
| 91 | extern void bcm1480_smp_finish(void); | ||
| 92 | bcm1480_smp_finish(); | ||
| 93 | #elif defined(CONFIG_SIBYTE_SB1250) | ||
| 83 | extern void sb1250_smp_finish(void); | 94 | extern void sb1250_smp_finish(void); |
| 84 | sb1250_smp_finish(); | 95 | sb1250_smp_finish(); |
| 96 | #else | ||
| 97 | #error invalid SMP configuration | ||
| 98 | #endif | ||
| 85 | } | 99 | } |
| 86 | 100 | ||
| 87 | /* | 101 | /* |
diff --git a/arch/mips/sibyte/swarm/setup.c b/arch/mips/sibyte/swarm/setup.c index f8963de1bbf4..b614ca0ddb69 100644 --- a/arch/mips/sibyte/swarm/setup.c +++ b/arch/mips/sibyte/swarm/setup.c | |||
| @@ -1,5 +1,5 @@ | |||
| 1 | /* | 1 | /* |
| 2 | * Copyright (C) 2000, 2001, 2002, 2003 Broadcom Corporation | 2 | * Copyright (C) 2000, 2001, 2002, 2003, 2004 Broadcom Corporation |
| 3 | * Copyright (C) 2004 by Ralf Baechle (ralf@linux-mips.org) | 3 | * Copyright (C) 2004 by Ralf Baechle (ralf@linux-mips.org) |
| 4 | * | 4 | * |
| 5 | * This program is free software; you can redistribute it and/or | 5 | * This program is free software; you can redistribute it and/or |
| @@ -39,11 +39,23 @@ | |||
| 39 | #include <asm/time.h> | 39 | #include <asm/time.h> |
| 40 | #include <asm/traps.h> | 40 | #include <asm/traps.h> |
| 41 | #include <asm/sibyte/sb1250.h> | 41 | #include <asm/sibyte/sb1250.h> |
| 42 | #if defined(CONFIG_SIBYTE_BCM1x55) || defined(CONFIG_SIBYTE_BCM1x80) | ||
| 43 | #include <asm/sibyte/bcm1480_regs.h> | ||
| 44 | #elif defined(CONFIG_SIBYTE_SB1250) || defined(CONFIG_SIBYTE_BCM112X) | ||
| 42 | #include <asm/sibyte/sb1250_regs.h> | 45 | #include <asm/sibyte/sb1250_regs.h> |
| 46 | #else | ||
| 47 | #error invalid SiByte board configuation | ||
| 48 | #endif | ||
| 43 | #include <asm/sibyte/sb1250_genbus.h> | 49 | #include <asm/sibyte/sb1250_genbus.h> |
| 44 | #include <asm/sibyte/board.h> | 50 | #include <asm/sibyte/board.h> |
| 45 | 51 | ||
| 52 | #if defined(CONFIG_SIBYTE_BCM1x55) || defined(CONFIG_SIBYTE_BCM1x80) | ||
| 53 | extern void bcm1480_setup(void); | ||
| 54 | #elif defined(CONFIG_SIBYTE_SB1250) || defined(CONFIG_SIBYTE_BCM112X) | ||
| 46 | extern void sb1250_setup(void); | 55 | extern void sb1250_setup(void); |
| 56 | #else | ||
| 57 | #error invalid SiByte board configuation | ||
| 58 | #endif | ||
| 47 | 59 | ||
| 48 | extern int xicor_probe(void); | 60 | extern int xicor_probe(void); |
| 49 | extern int xicor_set_time(unsigned long); | 61 | extern int xicor_set_time(unsigned long); |
| @@ -66,7 +78,13 @@ void __init swarm_timer_setup(struct irqaction *irq) | |||
| 66 | */ | 78 | */ |
| 67 | 79 | ||
| 68 | /* We only need to setup the generic timer */ | 80 | /* We only need to setup the generic timer */ |
| 69 | sb1250_time_init(); | 81 | #if defined(CONFIG_SIBYTE_BCM1x55) || defined(CONFIG_SIBYTE_BCM1x80) |
| 82 | bcm1480_time_init(); | ||
| 83 | #elif defined(CONFIG_SIBYTE_SB1250) || defined(CONFIG_SIBYTE_BCM112X) | ||
| 84 | sb1250_time_init(); | ||
| 85 | #else | ||
| 86 | #error invalid SiByte board configuation | ||
| 87 | #endif | ||
| 70 | } | 88 | } |
| 71 | 89 | ||
| 72 | int swarm_be_handler(struct pt_regs *regs, int is_fixup) | 90 | int swarm_be_handler(struct pt_regs *regs, int is_fixup) |
| @@ -81,7 +99,13 @@ int swarm_be_handler(struct pt_regs *regs, int is_fixup) | |||
| 81 | 99 | ||
| 82 | void __init plat_setup(void) | 100 | void __init plat_setup(void) |
| 83 | { | 101 | { |
| 102 | #if defined(CONFIG_SIBYTE_BCM1x55) || defined(CONFIG_SIBYTE_BCM1x80) | ||
| 103 | bcm1480_setup(); | ||
| 104 | #elif defined(CONFIG_SIBYTE_SB1250) || defined(CONFIG_SIBYTE_BCM112X) | ||
| 84 | sb1250_setup(); | 105 | sb1250_setup(); |
| 106 | #else | ||
| 107 | #error invalid SiByte board configuation | ||
| 108 | #endif | ||
| 85 | 109 | ||
| 86 | panic_timeout = 5; /* For debug. */ | 110 | panic_timeout = 5; /* For debug. */ |
| 87 | 111 | ||
