diff options
author | Linus Torvalds <torvalds@linux-foundation.org> | 2011-05-23 01:06:24 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@linux-foundation.org> | 2011-05-23 01:06:24 -0400 |
commit | e98bae7592a44bdce2e49ccd64f3c7ffe244a0f6 (patch) | |
tree | 1887da3331c5214c330226506d229222b454e960 /arch/sparc | |
parent | 4b382d0643603819e8b48da58efc254cabc22574 (diff) | |
parent | f400bdb1d6de4344980cf39041497b288090dd33 (diff) |
Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/sparc-next-2.6
* git://git.kernel.org/pub/scm/linux/kernel/git/davem/sparc-next-2.6: (28 commits)
sparc32: fix build, fix missing cpu_relax declaration
SCHED_TTWU_QUEUE is not longer needed since sparc32 now implements IPI
sparc32,leon: Remove unnecessary page_address calls in LEON DMA API.
sparc: convert old cpumask API into new one
sparc32, sun4d: Implemented SMP IPIs support for SUN4D machines
sparc32, sun4m: Implemented SMP IPIs support for SUN4M machines
sparc32,leon: Implemented SMP IPIs for LEON CPU
sparc32: implement SMP IPIs using the generic functions
sparc32,leon: SMP power down implementation
sparc32,leon: added some SMP comments
sparc: add {read,write}*_be routines
sparc32,leon: don't rely on bootloader to mask IRQs
sparc32,leon: operate on boot-cpu IRQ controller registers
sparc32: always define boot_cpu_id
sparc32: removed unused code, implemented by generic code
sparc32: avoid build warning at mm/percpu.c:1647
sparc32: always register a PROM based early console
sparc32: probe for cpu info only during startup
sparc: consolidate show_cpuinfo in cpu.c
sparc32,leon: implement genirq CPU affinity
...
Diffstat (limited to 'arch/sparc')
53 files changed, 1552 insertions, 1678 deletions
diff --git a/arch/sparc/Kconfig b/arch/sparc/Kconfig index e560d102215a..63a027c9ada5 100644 --- a/arch/sparc/Kconfig +++ b/arch/sparc/Kconfig | |||
@@ -25,6 +25,10 @@ config SPARC | |||
25 | select HAVE_DMA_ATTRS | 25 | select HAVE_DMA_ATTRS |
26 | select HAVE_DMA_API_DEBUG | 26 | select HAVE_DMA_API_DEBUG |
27 | select HAVE_ARCH_JUMP_LABEL | 27 | select HAVE_ARCH_JUMP_LABEL |
28 | select HAVE_GENERIC_HARDIRQS | ||
29 | select GENERIC_HARDIRQS_NO_DEPRECATED | ||
30 | select GENERIC_IRQ_SHOW | ||
31 | select USE_GENERIC_SMP_HELPERS if SMP | ||
28 | 32 | ||
29 | config SPARC32 | 33 | config SPARC32 |
30 | def_bool !64BIT | 34 | def_bool !64BIT |
@@ -43,15 +47,12 @@ config SPARC64 | |||
43 | select HAVE_DYNAMIC_FTRACE | 47 | select HAVE_DYNAMIC_FTRACE |
44 | select HAVE_FTRACE_MCOUNT_RECORD | 48 | select HAVE_FTRACE_MCOUNT_RECORD |
45 | select HAVE_SYSCALL_TRACEPOINTS | 49 | select HAVE_SYSCALL_TRACEPOINTS |
46 | select USE_GENERIC_SMP_HELPERS if SMP | ||
47 | select RTC_DRV_CMOS | 50 | select RTC_DRV_CMOS |
48 | select RTC_DRV_BQ4802 | 51 | select RTC_DRV_BQ4802 |
49 | select RTC_DRV_SUN4V | 52 | select RTC_DRV_SUN4V |
50 | select RTC_DRV_STARFIRE | 53 | select RTC_DRV_STARFIRE |
51 | select HAVE_PERF_EVENTS | 54 | select HAVE_PERF_EVENTS |
52 | select PERF_USE_VMALLOC | 55 | select PERF_USE_VMALLOC |
53 | select HAVE_GENERIC_HARDIRQS | ||
54 | select GENERIC_IRQ_SHOW | ||
55 | select IRQ_PREFLOW_FASTEOI | 56 | select IRQ_PREFLOW_FASTEOI |
56 | 57 | ||
57 | config ARCH_DEFCONFIG | 58 | config ARCH_DEFCONFIG |
diff --git a/arch/sparc/include/asm/cpudata_32.h b/arch/sparc/include/asm/cpudata_32.h index 31d48a0e32c7..a4c5a938b936 100644 --- a/arch/sparc/include/asm/cpudata_32.h +++ b/arch/sparc/include/asm/cpudata_32.h | |||
@@ -16,6 +16,10 @@ typedef struct { | |||
16 | unsigned long clock_tick; | 16 | unsigned long clock_tick; |
17 | unsigned int multiplier; | 17 | unsigned int multiplier; |
18 | unsigned int counter; | 18 | unsigned int counter; |
19 | #ifdef CONFIG_SMP | ||
20 | unsigned int irq_resched_count; | ||
21 | unsigned int irq_call_count; | ||
22 | #endif | ||
19 | int prom_node; | 23 | int prom_node; |
20 | int mid; | 24 | int mid; |
21 | int next; | 25 | int next; |
@@ -23,5 +27,6 @@ typedef struct { | |||
23 | 27 | ||
24 | DECLARE_PER_CPU(cpuinfo_sparc, __cpu_data); | 28 | DECLARE_PER_CPU(cpuinfo_sparc, __cpu_data); |
25 | #define cpu_data(__cpu) per_cpu(__cpu_data, (__cpu)) | 29 | #define cpu_data(__cpu) per_cpu(__cpu_data, (__cpu)) |
30 | #define local_cpu_data() __get_cpu_var(__cpu_data) | ||
26 | 31 | ||
27 | #endif /* _SPARC_CPUDATA_H */ | 32 | #endif /* _SPARC_CPUDATA_H */ |
diff --git a/arch/sparc/include/asm/floppy_32.h b/arch/sparc/include/asm/floppy_32.h index 86666f70322e..482c79e2a416 100644 --- a/arch/sparc/include/asm/floppy_32.h +++ b/arch/sparc/include/asm/floppy_32.h | |||
@@ -281,28 +281,27 @@ static inline void sun_fd_enable_dma(void) | |||
281 | pdma_areasize = pdma_size; | 281 | pdma_areasize = pdma_size; |
282 | } | 282 | } |
283 | 283 | ||
284 | /* Our low-level entry point in arch/sparc/kernel/entry.S */ | 284 | extern int sparc_floppy_request_irq(unsigned int irq, |
285 | extern int sparc_floppy_request_irq(int irq, unsigned long flags, | 285 | irq_handler_t irq_handler); |
286 | irq_handler_t irq_handler); | ||
287 | 286 | ||
288 | static int sun_fd_request_irq(void) | 287 | static int sun_fd_request_irq(void) |
289 | { | 288 | { |
290 | static int once = 0; | 289 | static int once = 0; |
291 | int error; | ||
292 | 290 | ||
293 | if(!once) { | 291 | if (!once) { |
294 | once = 1; | 292 | once = 1; |
295 | error = sparc_floppy_request_irq(FLOPPY_IRQ, | 293 | return sparc_floppy_request_irq(FLOPPY_IRQ, floppy_interrupt); |
296 | IRQF_DISABLED, | 294 | } else { |
297 | floppy_interrupt); | 295 | return 0; |
298 | return ((error == 0) ? 0 : -1); | 296 | } |
299 | } else return 0; | ||
300 | } | 297 | } |
301 | 298 | ||
302 | static struct linux_prom_registers fd_regs[2]; | 299 | static struct linux_prom_registers fd_regs[2]; |
303 | 300 | ||
304 | static int sun_floppy_init(void) | 301 | static int sun_floppy_init(void) |
305 | { | 302 | { |
303 | struct platform_device *op; | ||
304 | struct device_node *dp; | ||
306 | char state[128]; | 305 | char state[128]; |
307 | phandle tnode, fd_node; | 306 | phandle tnode, fd_node; |
308 | int num_regs; | 307 | int num_regs; |
@@ -310,7 +309,6 @@ static int sun_floppy_init(void) | |||
310 | 309 | ||
311 | use_virtual_dma = 1; | 310 | use_virtual_dma = 1; |
312 | 311 | ||
313 | FLOPPY_IRQ = 11; | ||
314 | /* Forget it if we aren't on a machine that could possibly | 312 | /* Forget it if we aren't on a machine that could possibly |
315 | * ever have a floppy drive. | 313 | * ever have a floppy drive. |
316 | */ | 314 | */ |
@@ -349,6 +347,26 @@ static int sun_floppy_init(void) | |||
349 | sun_fdc = (struct sun_flpy_controller *) | 347 | sun_fdc = (struct sun_flpy_controller *) |
350 | of_ioremap(&r, 0, fd_regs[0].reg_size, "floppy"); | 348 | of_ioremap(&r, 0, fd_regs[0].reg_size, "floppy"); |
351 | 349 | ||
350 | /* Look up irq in platform_device. | ||
351 | * We try "SUNW,fdtwo" and "fd" | ||
352 | */ | ||
353 | for_each_node_by_name(dp, "SUNW,fdtwo") { | ||
354 | op = of_find_device_by_node(dp); | ||
355 | if (op) | ||
356 | break; | ||
357 | } | ||
358 | if (!op) { | ||
359 | for_each_node_by_name(dp, "fd") { | ||
360 | op = of_find_device_by_node(dp); | ||
361 | if (op) | ||
362 | break; | ||
363 | } | ||
364 | } | ||
365 | if (!op) | ||
366 | goto no_sun_fdc; | ||
367 | |||
368 | FLOPPY_IRQ = op->archdata.irqs[0]; | ||
369 | |||
352 | /* Last minute sanity check... */ | 370 | /* Last minute sanity check... */ |
353 | if(sun_fdc->status_82072 == 0xff) { | 371 | if(sun_fdc->status_82072 == 0xff) { |
354 | sun_fdc = NULL; | 372 | sun_fdc = NULL; |
diff --git a/arch/sparc/include/asm/io.h b/arch/sparc/include/asm/io.h index a34b2994937a..f6902cf3cbe9 100644 --- a/arch/sparc/include/asm/io.h +++ b/arch/sparc/include/asm/io.h | |||
@@ -5,4 +5,17 @@ | |||
5 | #else | 5 | #else |
6 | #include <asm/io_32.h> | 6 | #include <asm/io_32.h> |
7 | #endif | 7 | #endif |
8 | |||
9 | /* | ||
10 | * Defines used for both SPARC32 and SPARC64 | ||
11 | */ | ||
12 | |||
13 | /* Big endian versions of memory read/write routines */ | ||
14 | #define readb_be(__addr) __raw_readb(__addr) | ||
15 | #define readw_be(__addr) __raw_readw(__addr) | ||
16 | #define readl_be(__addr) __raw_readl(__addr) | ||
17 | #define writeb_be(__b, __addr) __raw_writeb(__b, __addr) | ||
18 | #define writel_be(__w, __addr) __raw_writel(__w, __addr) | ||
19 | #define writew_be(__l, __addr) __raw_writew(__l, __addr) | ||
20 | |||
8 | #endif | 21 | #endif |
diff --git a/arch/sparc/include/asm/irq_32.h b/arch/sparc/include/asm/irq_32.h index eced3e3ebd30..2ae3acaeb1b3 100644 --- a/arch/sparc/include/asm/irq_32.h +++ b/arch/sparc/include/asm/irq_32.h | |||
@@ -6,7 +6,11 @@ | |||
6 | #ifndef _SPARC_IRQ_H | 6 | #ifndef _SPARC_IRQ_H |
7 | #define _SPARC_IRQ_H | 7 | #define _SPARC_IRQ_H |
8 | 8 | ||
9 | #define NR_IRQS 16 | 9 | /* Allocated number of logical irq numbers. |
10 | * sun4d boxes (ss2000e) should be OK with ~32. | ||
11 | * Be on the safe side and make room for 64 | ||
12 | */ | ||
13 | #define NR_IRQS 64 | ||
10 | 14 | ||
11 | #include <linux/interrupt.h> | 15 | #include <linux/interrupt.h> |
12 | 16 | ||
diff --git a/arch/sparc/include/asm/leon.h b/arch/sparc/include/asm/leon.h index c04f96fb753c..6bdaf1e43d2a 100644 --- a/arch/sparc/include/asm/leon.h +++ b/arch/sparc/include/asm/leon.h | |||
@@ -52,29 +52,6 @@ | |||
52 | #define LEON_DIAGF_VALID 0x2000 | 52 | #define LEON_DIAGF_VALID 0x2000 |
53 | #define LEON_DIAGF_VALID_SHIFT 13 | 53 | #define LEON_DIAGF_VALID_SHIFT 13 |
54 | 54 | ||
55 | /* | ||
56 | * Interrupt Sources | ||
57 | * | ||
58 | * The interrupt source numbers directly map to the trap type and to | ||
59 | * the bits used in the Interrupt Clear, Interrupt Force, Interrupt Mask, | ||
60 | * and the Interrupt Pending Registers. | ||
61 | */ | ||
62 | #define LEON_INTERRUPT_CORRECTABLE_MEMORY_ERROR 1 | ||
63 | #define LEON_INTERRUPT_UART_1_RX_TX 2 | ||
64 | #define LEON_INTERRUPT_UART_0_RX_TX 3 | ||
65 | #define LEON_INTERRUPT_EXTERNAL_0 4 | ||
66 | #define LEON_INTERRUPT_EXTERNAL_1 5 | ||
67 | #define LEON_INTERRUPT_EXTERNAL_2 6 | ||
68 | #define LEON_INTERRUPT_EXTERNAL_3 7 | ||
69 | #define LEON_INTERRUPT_TIMER1 8 | ||
70 | #define LEON_INTERRUPT_TIMER2 9 | ||
71 | #define LEON_INTERRUPT_EMPTY1 10 | ||
72 | #define LEON_INTERRUPT_EMPTY2 11 | ||
73 | #define LEON_INTERRUPT_OPEN_ETH 12 | ||
74 | #define LEON_INTERRUPT_EMPTY4 13 | ||
75 | #define LEON_INTERRUPT_EMPTY5 14 | ||
76 | #define LEON_INTERRUPT_EMPTY6 15 | ||
77 | |||
78 | /* irq masks */ | 55 | /* irq masks */ |
79 | #define LEON_HARD_INT(x) (1 << (x)) /* irq 0-15 */ | 56 | #define LEON_HARD_INT(x) (1 << (x)) /* irq 0-15 */ |
80 | #define LEON_IRQMASK_R 0x0000fffe /* bit 15- 1 of lregs.irqmask */ | 57 | #define LEON_IRQMASK_R 0x0000fffe /* bit 15- 1 of lregs.irqmask */ |
@@ -183,7 +160,6 @@ static inline void leon_srmmu_enabletlb(void) | |||
183 | /* macro access for leon_readnobuffer_reg() */ | 160 | /* macro access for leon_readnobuffer_reg() */ |
184 | #define LEON_BYPASSCACHE_LOAD_VA(x) leon_readnobuffer_reg((unsigned long)(x)) | 161 | #define LEON_BYPASSCACHE_LOAD_VA(x) leon_readnobuffer_reg((unsigned long)(x)) |
185 | 162 | ||
186 | extern void sparc_leon_eirq_register(int eirq); | ||
187 | extern void leon_init(void); | 163 | extern void leon_init(void); |
188 | extern void leon_switch_mm(void); | 164 | extern void leon_switch_mm(void); |
189 | extern void leon_init_IRQ(void); | 165 | extern void leon_init_IRQ(void); |
@@ -239,8 +215,8 @@ static inline int sparc_leon3_cpuid(void) | |||
239 | #endif /*!__ASSEMBLY__*/ | 215 | #endif /*!__ASSEMBLY__*/ |
240 | 216 | ||
241 | #ifdef CONFIG_SMP | 217 | #ifdef CONFIG_SMP |
242 | # define LEON3_IRQ_RESCHEDULE 13 | 218 | # define LEON3_IRQ_IPI_DEFAULT 13 |
243 | # define LEON3_IRQ_TICKER (leon_percpu_timer_dev[0].irq) | 219 | # define LEON3_IRQ_TICKER (leon3_ticker_irq) |
244 | # define LEON3_IRQ_CROSS_CALL 15 | 220 | # define LEON3_IRQ_CROSS_CALL 15 |
245 | #endif | 221 | #endif |
246 | 222 | ||
@@ -339,9 +315,9 @@ struct leon2_cacheregs { | |||
339 | #include <linux/interrupt.h> | 315 | #include <linux/interrupt.h> |
340 | 316 | ||
341 | struct device_node; | 317 | struct device_node; |
342 | extern int sparc_leon_eirq_get(int eirq, int cpu); | 318 | extern unsigned int leon_build_device_irq(unsigned int real_irq, |
343 | extern irqreturn_t sparc_leon_eirq_isr(int dummy, void *dev_id); | 319 | irq_flow_handler_t flow_handler, |
344 | extern void sparc_leon_eirq_register(int eirq); | 320 | const char *name, int do_ack); |
345 | extern void leon_clear_clock_irq(void); | 321 | extern void leon_clear_clock_irq(void); |
346 | extern void leon_load_profile_irq(int cpu, unsigned int limit); | 322 | extern void leon_load_profile_irq(int cpu, unsigned int limit); |
347 | extern void leon_init_timers(irq_handler_t counter_fn); | 323 | extern void leon_init_timers(irq_handler_t counter_fn); |
@@ -358,6 +334,7 @@ extern void leon3_getCacheRegs(struct leon3_cacheregs *regs); | |||
358 | extern int leon_flush_needed(void); | 334 | extern int leon_flush_needed(void); |
359 | extern void leon_switch_mm(void); | 335 | extern void leon_switch_mm(void); |
360 | extern int srmmu_swprobe_trace; | 336 | extern int srmmu_swprobe_trace; |
337 | extern int leon3_ticker_irq; | ||
361 | 338 | ||
362 | #ifdef CONFIG_SMP | 339 | #ifdef CONFIG_SMP |
363 | extern int leon_smp_nrcpus(void); | 340 | extern int leon_smp_nrcpus(void); |
@@ -366,17 +343,19 @@ extern void leon_smp_done(void); | |||
366 | extern void leon_boot_cpus(void); | 343 | extern void leon_boot_cpus(void); |
367 | extern int leon_boot_one_cpu(int i); | 344 | extern int leon_boot_one_cpu(int i); |
368 | void leon_init_smp(void); | 345 | void leon_init_smp(void); |
369 | extern void cpu_probe(void); | ||
370 | extern void cpu_idle(void); | 346 | extern void cpu_idle(void); |
371 | extern void init_IRQ(void); | 347 | extern void init_IRQ(void); |
372 | extern void cpu_panic(void); | 348 | extern void cpu_panic(void); |
373 | extern int __leon_processor_id(void); | 349 | extern int __leon_processor_id(void); |
374 | void leon_enable_irq_cpu(unsigned int irq_nr, unsigned int cpu); | 350 | void leon_enable_irq_cpu(unsigned int irq_nr, unsigned int cpu); |
351 | extern irqreturn_t leon_percpu_timer_interrupt(int irq, void *unused); | ||
375 | 352 | ||
376 | extern unsigned int real_irq_entry[], smpleon_ticker[]; | 353 | extern unsigned int real_irq_entry[]; |
354 | extern unsigned int smpleon_ipi[]; | ||
377 | extern unsigned int patchme_maybe_smp_msg[]; | 355 | extern unsigned int patchme_maybe_smp_msg[]; |
378 | extern unsigned int t_nmi[], linux_trap_ipi15_leon[]; | 356 | extern unsigned int t_nmi[], linux_trap_ipi15_leon[]; |
379 | extern unsigned int linux_trap_ipi15_sun4m[]; | 357 | extern unsigned int linux_trap_ipi15_sun4m[]; |
358 | extern int leon_ipi_irq; | ||
380 | 359 | ||
381 | #endif /* CONFIG_SMP */ | 360 | #endif /* CONFIG_SMP */ |
382 | 361 | ||
diff --git a/arch/sparc/include/asm/pcic.h b/arch/sparc/include/asm/pcic.h index f20ef562b265..7eb5d78f5211 100644 --- a/arch/sparc/include/asm/pcic.h +++ b/arch/sparc/include/asm/pcic.h | |||
@@ -29,11 +29,17 @@ struct linux_pcic { | |||
29 | int pcic_imdim; | 29 | int pcic_imdim; |
30 | }; | 30 | }; |
31 | 31 | ||
32 | extern int pcic_probe(void); | 32 | #ifdef CONFIG_PCI |
33 | /* Erm... MJ redefined pcibios_present() so that it does not work early. */ | ||
34 | extern int pcic_present(void); | 33 | extern int pcic_present(void); |
34 | extern int pcic_probe(void); | ||
35 | extern void pci_time_init(void); | ||
35 | extern void sun4m_pci_init_IRQ(void); | 36 | extern void sun4m_pci_init_IRQ(void); |
36 | 37 | #else | |
38 | static inline int pcic_present(void) { return 0; } | ||
39 | static inline int pcic_probe(void) { return 0; } | ||
40 | static inline void pci_time_init(void) {} | ||
41 | static inline void sun4m_pci_init_IRQ(void) {} | ||
42 | #endif | ||
37 | #endif | 43 | #endif |
38 | 44 | ||
39 | /* Size of PCI I/O space which we relocate. */ | 45 | /* Size of PCI I/O space which we relocate. */ |
diff --git a/arch/sparc/include/asm/pgtable_32.h b/arch/sparc/include/asm/pgtable_32.h index 303bd4dc8292..5b31a8e89823 100644 --- a/arch/sparc/include/asm/pgtable_32.h +++ b/arch/sparc/include/asm/pgtable_32.h | |||
@@ -8,6 +8,8 @@ | |||
8 | * Copyright (C) 1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz) | 8 | * Copyright (C) 1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz) |
9 | */ | 9 | */ |
10 | 10 | ||
11 | #include <linux/const.h> | ||
12 | |||
11 | #ifndef __ASSEMBLY__ | 13 | #ifndef __ASSEMBLY__ |
12 | #include <asm-generic/4level-fixup.h> | 14 | #include <asm-generic/4level-fixup.h> |
13 | 15 | ||
@@ -456,9 +458,9 @@ extern int io_remap_pfn_range(struct vm_area_struct *vma, | |||
456 | 458 | ||
457 | #endif /* !(__ASSEMBLY__) */ | 459 | #endif /* !(__ASSEMBLY__) */ |
458 | 460 | ||
459 | #define VMALLOC_START 0xfe600000 | 461 | #define VMALLOC_START _AC(0xfe600000,UL) |
460 | /* XXX Alter this when I get around to fixing sun4c - Anton */ | 462 | /* XXX Alter this when I get around to fixing sun4c - Anton */ |
461 | #define VMALLOC_END 0xffc00000 | 463 | #define VMALLOC_END _AC(0xffc00000,UL) |
462 | 464 | ||
463 | 465 | ||
464 | /* We provide our own get_unmapped_area to cope with VA holes for userland */ | 466 | /* We provide our own get_unmapped_area to cope with VA holes for userland */ |
diff --git a/arch/sparc/include/asm/pgtable_64.h b/arch/sparc/include/asm/pgtable_64.h index f8dddb7045bb..b77128c80524 100644 --- a/arch/sparc/include/asm/pgtable_64.h +++ b/arch/sparc/include/asm/pgtable_64.h | |||
@@ -699,6 +699,9 @@ extern pmd_t swapper_low_pmd_dir[2048]; | |||
699 | extern void paging_init(void); | 699 | extern void paging_init(void); |
700 | extern unsigned long find_ecache_flush_span(unsigned long size); | 700 | extern unsigned long find_ecache_flush_span(unsigned long size); |
701 | 701 | ||
702 | struct seq_file; | ||
703 | extern void mmu_info(struct seq_file *); | ||
704 | |||
702 | /* These do nothing with the way I have things setup. */ | 705 | /* These do nothing with the way I have things setup. */ |
703 | #define mmu_lockarea(vaddr, len) (vaddr) | 706 | #define mmu_lockarea(vaddr, len) (vaddr) |
704 | #define mmu_unlockarea(vaddr, len) do { } while(0) | 707 | #define mmu_unlockarea(vaddr, len) do { } while(0) |
diff --git a/arch/sparc/include/asm/setup.h b/arch/sparc/include/asm/setup.h index 2643c62f4ac0..64718ba26434 100644 --- a/arch/sparc/include/asm/setup.h +++ b/arch/sparc/include/asm/setup.h | |||
@@ -11,4 +11,16 @@ | |||
11 | # define COMMAND_LINE_SIZE 256 | 11 | # define COMMAND_LINE_SIZE 256 |
12 | #endif | 12 | #endif |
13 | 13 | ||
14 | #ifdef __KERNEL__ | ||
15 | |||
16 | #ifdef CONFIG_SPARC32 | ||
17 | /* The CPU that was used for booting | ||
18 | * Only sun4d + leon may have boot_cpu_id != 0 | ||
19 | */ | ||
20 | extern unsigned char boot_cpu_id; | ||
21 | extern unsigned char boot_cpu_id4; | ||
22 | #endif | ||
23 | |||
24 | #endif /* __KERNEL__ */ | ||
25 | |||
14 | #endif /* _SPARC_SETUP_H */ | 26 | #endif /* _SPARC_SETUP_H */ |
diff --git a/arch/sparc/include/asm/smp_32.h b/arch/sparc/include/asm/smp_32.h index d82d7f4c0a79..093f10843ff2 100644 --- a/arch/sparc/include/asm/smp_32.h +++ b/arch/sparc/include/asm/smp_32.h | |||
@@ -50,42 +50,38 @@ void smp_callin(void); | |||
50 | void smp_boot_cpus(void); | 50 | void smp_boot_cpus(void); |
51 | void smp_store_cpu_info(int); | 51 | void smp_store_cpu_info(int); |
52 | 52 | ||
53 | void smp_resched_interrupt(void); | ||
54 | void smp_call_function_single_interrupt(void); | ||
55 | void smp_call_function_interrupt(void); | ||
56 | |||
53 | struct seq_file; | 57 | struct seq_file; |
54 | void smp_bogo(struct seq_file *); | 58 | void smp_bogo(struct seq_file *); |
55 | void smp_info(struct seq_file *); | 59 | void smp_info(struct seq_file *); |
56 | 60 | ||
57 | BTFIXUPDEF_CALL(void, smp_cross_call, smpfunc_t, cpumask_t, unsigned long, unsigned long, unsigned long, unsigned long) | 61 | BTFIXUPDEF_CALL(void, smp_cross_call, smpfunc_t, cpumask_t, unsigned long, unsigned long, unsigned long, unsigned long) |
58 | BTFIXUPDEF_CALL(int, __hard_smp_processor_id, void) | 62 | BTFIXUPDEF_CALL(int, __hard_smp_processor_id, void) |
63 | BTFIXUPDEF_CALL(void, smp_ipi_resched, int); | ||
64 | BTFIXUPDEF_CALL(void, smp_ipi_single, int); | ||
65 | BTFIXUPDEF_CALL(void, smp_ipi_mask_one, int); | ||
59 | BTFIXUPDEF_BLACKBOX(hard_smp_processor_id) | 66 | BTFIXUPDEF_BLACKBOX(hard_smp_processor_id) |
60 | BTFIXUPDEF_BLACKBOX(load_current) | 67 | BTFIXUPDEF_BLACKBOX(load_current) |
61 | 68 | ||
62 | #define smp_cross_call(func,mask,arg1,arg2,arg3,arg4) BTFIXUP_CALL(smp_cross_call)(func,mask,arg1,arg2,arg3,arg4) | 69 | #define smp_cross_call(func,mask,arg1,arg2,arg3,arg4) BTFIXUP_CALL(smp_cross_call)(func,mask,arg1,arg2,arg3,arg4) |
63 | 70 | ||
64 | static inline void xc0(smpfunc_t func) { smp_cross_call(func, cpu_online_map, 0, 0, 0, 0); } | 71 | static inline void xc0(smpfunc_t func) { smp_cross_call(func, *cpu_online_mask, 0, 0, 0, 0); } |
65 | static inline void xc1(smpfunc_t func, unsigned long arg1) | 72 | static inline void xc1(smpfunc_t func, unsigned long arg1) |
66 | { smp_cross_call(func, cpu_online_map, arg1, 0, 0, 0); } | 73 | { smp_cross_call(func, *cpu_online_mask, arg1, 0, 0, 0); } |
67 | static inline void xc2(smpfunc_t func, unsigned long arg1, unsigned long arg2) | 74 | static inline void xc2(smpfunc_t func, unsigned long arg1, unsigned long arg2) |
68 | { smp_cross_call(func, cpu_online_map, arg1, arg2, 0, 0); } | 75 | { smp_cross_call(func, *cpu_online_mask, arg1, arg2, 0, 0); } |
69 | static inline void xc3(smpfunc_t func, unsigned long arg1, unsigned long arg2, | 76 | static inline void xc3(smpfunc_t func, unsigned long arg1, unsigned long arg2, |
70 | unsigned long arg3) | 77 | unsigned long arg3) |
71 | { smp_cross_call(func, cpu_online_map, arg1, arg2, arg3, 0); } | 78 | { smp_cross_call(func, *cpu_online_mask, arg1, arg2, arg3, 0); } |
72 | static inline void xc4(smpfunc_t func, unsigned long arg1, unsigned long arg2, | 79 | static inline void xc4(smpfunc_t func, unsigned long arg1, unsigned long arg2, |
73 | unsigned long arg3, unsigned long arg4) | 80 | unsigned long arg3, unsigned long arg4) |
74 | { smp_cross_call(func, cpu_online_map, arg1, arg2, arg3, arg4); } | 81 | { smp_cross_call(func, *cpu_online_mask, arg1, arg2, arg3, arg4); } |
75 | |||
76 | static inline int smp_call_function(void (*func)(void *info), void *info, int wait) | ||
77 | { | ||
78 | xc1((smpfunc_t)func, (unsigned long)info); | ||
79 | return 0; | ||
80 | } | ||
81 | 82 | ||
82 | static inline int smp_call_function_single(int cpuid, void (*func) (void *info), | 83 | extern void arch_send_call_function_single_ipi(int cpu); |
83 | void *info, int wait) | 84 | extern void arch_send_call_function_ipi_mask(const struct cpumask *mask); |
84 | { | ||
85 | smp_cross_call((smpfunc_t)func, cpumask_of_cpu(cpuid), | ||
86 | (unsigned long) info, 0, 0, 0); | ||
87 | return 0; | ||
88 | } | ||
89 | 85 | ||
90 | static inline int cpu_logical_map(int cpu) | 86 | static inline int cpu_logical_map(int cpu) |
91 | { | 87 | { |
@@ -135,6 +131,11 @@ static inline int hard_smp_processor_id(void) | |||
135 | __asm__ __volatile__("lda [%g0] ASI_M_VIKING_TMP1, %0\n\t" | 131 | __asm__ __volatile__("lda [%g0] ASI_M_VIKING_TMP1, %0\n\t" |
136 | "nop; nop" : | 132 | "nop; nop" : |
137 | "=&r" (cpuid)); | 133 | "=&r" (cpuid)); |
134 | - leon | ||
135 | __asm__ __volatile__( "rd %asr17, %0\n\t" | ||
136 | "srl %0, 0x1c, %0\n\t" | ||
137 | "nop\n\t" : | ||
138 | "=&r" (cpuid)); | ||
138 | See btfixup.h and btfixupprep.c to understand how a blackbox works. | 139 | See btfixup.h and btfixupprep.c to understand how a blackbox works. |
139 | */ | 140 | */ |
140 | __asm__ __volatile__("sethi %%hi(___b_hard_smp_processor_id), %0\n\t" | 141 | __asm__ __volatile__("sethi %%hi(___b_hard_smp_processor_id), %0\n\t" |
diff --git a/arch/sparc/include/asm/smp_64.h b/arch/sparc/include/asm/smp_64.h index f49e11cd4ded..20bca8950710 100644 --- a/arch/sparc/include/asm/smp_64.h +++ b/arch/sparc/include/asm/smp_64.h | |||
@@ -49,6 +49,10 @@ extern void cpu_play_dead(void); | |||
49 | 49 | ||
50 | extern void smp_fetch_global_regs(void); | 50 | extern void smp_fetch_global_regs(void); |
51 | 51 | ||
52 | struct seq_file; | ||
53 | void smp_bogo(struct seq_file *); | ||
54 | void smp_info(struct seq_file *); | ||
55 | |||
52 | #ifdef CONFIG_HOTPLUG_CPU | 56 | #ifdef CONFIG_HOTPLUG_CPU |
53 | extern int __cpu_disable(void); | 57 | extern int __cpu_disable(void); |
54 | extern void __cpu_die(unsigned int cpu); | 58 | extern void __cpu_die(unsigned int cpu); |
diff --git a/arch/sparc/include/asm/spinlock_32.h b/arch/sparc/include/asm/spinlock_32.h index 7f9b9dba38a6..5f5b8bf3f50d 100644 --- a/arch/sparc/include/asm/spinlock_32.h +++ b/arch/sparc/include/asm/spinlock_32.h | |||
@@ -9,6 +9,7 @@ | |||
9 | #ifndef __ASSEMBLY__ | 9 | #ifndef __ASSEMBLY__ |
10 | 10 | ||
11 | #include <asm/psr.h> | 11 | #include <asm/psr.h> |
12 | #include <asm/processor.h> /* for cpu_relax */ | ||
12 | 13 | ||
13 | #define arch_spin_is_locked(lock) (*((volatile unsigned char *)(lock)) != 0) | 14 | #define arch_spin_is_locked(lock) (*((volatile unsigned char *)(lock)) != 0) |
14 | 15 | ||
diff --git a/arch/sparc/include/asm/system_32.h b/arch/sparc/include/asm/system_32.h index 890036b3689a..47a7e862474e 100644 --- a/arch/sparc/include/asm/system_32.h +++ b/arch/sparc/include/asm/system_32.h | |||
@@ -15,11 +15,6 @@ | |||
15 | 15 | ||
16 | #include <linux/irqflags.h> | 16 | #include <linux/irqflags.h> |
17 | 17 | ||
18 | static inline unsigned int probe_irq_mask(unsigned long val) | ||
19 | { | ||
20 | return 0; | ||
21 | } | ||
22 | |||
23 | /* | 18 | /* |
24 | * Sparc (general) CPU types | 19 | * Sparc (general) CPU types |
25 | */ | 20 | */ |
diff --git a/arch/sparc/include/asm/system_64.h b/arch/sparc/include/asm/system_64.h index e3b65d8cf41b..3c96d3bb9f15 100644 --- a/arch/sparc/include/asm/system_64.h +++ b/arch/sparc/include/asm/system_64.h | |||
@@ -29,10 +29,6 @@ enum sparc_cpu { | |||
29 | /* This cannot ever be a sun4c :) That's just history. */ | 29 | /* This cannot ever be a sun4c :) That's just history. */ |
30 | #define ARCH_SUN4C 0 | 30 | #define ARCH_SUN4C 0 |
31 | 31 | ||
32 | extern const char *sparc_cpu_type; | ||
33 | extern const char *sparc_fpu_type; | ||
34 | extern const char *sparc_pmu_type; | ||
35 | |||
36 | extern char reboot_command[]; | 32 | extern char reboot_command[]; |
37 | 33 | ||
38 | /* These are here in an effort to more fully work around Spitfire Errata | 34 | /* These are here in an effort to more fully work around Spitfire Errata |
diff --git a/arch/sparc/include/asm/winmacro.h b/arch/sparc/include/asm/winmacro.h index 5b0a06dc3bcb..a9be04b0d049 100644 --- a/arch/sparc/include/asm/winmacro.h +++ b/arch/sparc/include/asm/winmacro.h | |||
@@ -103,6 +103,7 @@ | |||
103 | st %scratch, [%cur_reg + TI_W_SAVED]; | 103 | st %scratch, [%cur_reg + TI_W_SAVED]; |
104 | 104 | ||
105 | #ifdef CONFIG_SMP | 105 | #ifdef CONFIG_SMP |
106 | /* Results of LOAD_CURRENT() after BTFIXUP for SUN4M, SUN4D & LEON (comments) */ | ||
106 | #define LOAD_CURRENT4M(dest_reg, idreg) \ | 107 | #define LOAD_CURRENT4M(dest_reg, idreg) \ |
107 | rd %tbr, %idreg; \ | 108 | rd %tbr, %idreg; \ |
108 | sethi %hi(current_set), %dest_reg; \ | 109 | sethi %hi(current_set), %dest_reg; \ |
@@ -118,6 +119,14 @@ | |||
118 | or %dest_reg, %lo(C_LABEL(current_set)), %dest_reg; \ | 119 | or %dest_reg, %lo(C_LABEL(current_set)), %dest_reg; \ |
119 | ld [%idreg + %dest_reg], %dest_reg; | 120 | ld [%idreg + %dest_reg], %dest_reg; |
120 | 121 | ||
122 | #define LOAD_CURRENT_LEON(dest_reg, idreg) \ | ||
123 | rd %asr17, %idreg; \ | ||
124 | sethi %hi(current_set), %dest_reg; \ | ||
125 | srl %idreg, 0x1c, %idreg; \ | ||
126 | or %dest_reg, %lo(current_set), %dest_reg; \ | ||
127 | sll %idreg, 0x2, %idreg; \ | ||
128 | ld [%idreg + %dest_reg], %dest_reg; | ||
129 | |||
121 | /* Blackbox - take care with this... - check smp4m and smp4d before changing this. */ | 130 | /* Blackbox - take care with this... - check smp4m and smp4d before changing this. */ |
122 | #define LOAD_CURRENT(dest_reg, idreg) \ | 131 | #define LOAD_CURRENT(dest_reg, idreg) \ |
123 | sethi %hi(___b_load_current), %idreg; \ | 132 | sethi %hi(___b_load_current), %idreg; \ |
diff --git a/arch/sparc/kernel/Makefile b/arch/sparc/kernel/Makefile index 99aa4db6e9c2..9cff2709a96d 100644 --- a/arch/sparc/kernel/Makefile +++ b/arch/sparc/kernel/Makefile | |||
@@ -71,10 +71,6 @@ obj-$(CONFIG_SPARC64) += pcr.o | |||
71 | obj-$(CONFIG_SPARC64) += nmi.o | 71 | obj-$(CONFIG_SPARC64) += nmi.o |
72 | obj-$(CONFIG_SPARC64_SMP) += cpumap.o | 72 | obj-$(CONFIG_SPARC64_SMP) += cpumap.o |
73 | 73 | ||
74 | # sparc32 do not use GENERIC_HARDIRQS but uses the generic devres implementation | ||
75 | obj-$(CONFIG_SPARC32) += devres.o | ||
76 | devres-y := ../../../kernel/irq/devres.o | ||
77 | |||
78 | obj-y += dma.o | 74 | obj-y += dma.o |
79 | 75 | ||
80 | obj-$(CONFIG_SPARC32_PCI) += pcic.o | 76 | obj-$(CONFIG_SPARC32_PCI) += pcic.o |
diff --git a/arch/sparc/kernel/cpu.c b/arch/sparc/kernel/cpu.c index 7925c54f4133..138dbbc8dc84 100644 --- a/arch/sparc/kernel/cpu.c +++ b/arch/sparc/kernel/cpu.c | |||
@@ -4,6 +4,7 @@ | |||
4 | * Copyright (C) 1996 David S. Miller (davem@caip.rutgers.edu) | 4 | * Copyright (C) 1996 David S. Miller (davem@caip.rutgers.edu) |
5 | */ | 5 | */ |
6 | 6 | ||
7 | #include <linux/seq_file.h> | ||
7 | #include <linux/kernel.h> | 8 | #include <linux/kernel.h> |
8 | #include <linux/module.h> | 9 | #include <linux/module.h> |
9 | #include <linux/init.h> | 10 | #include <linux/init.h> |
@@ -11,7 +12,9 @@ | |||
11 | #include <linux/threads.h> | 12 | #include <linux/threads.h> |
12 | 13 | ||
13 | #include <asm/spitfire.h> | 14 | #include <asm/spitfire.h> |
15 | #include <asm/pgtable.h> | ||
14 | #include <asm/oplib.h> | 16 | #include <asm/oplib.h> |
17 | #include <asm/setup.h> | ||
15 | #include <asm/page.h> | 18 | #include <asm/page.h> |
16 | #include <asm/head.h> | 19 | #include <asm/head.h> |
17 | #include <asm/psr.h> | 20 | #include <asm/psr.h> |
@@ -23,6 +26,9 @@ | |||
23 | DEFINE_PER_CPU(cpuinfo_sparc, __cpu_data) = { 0 }; | 26 | DEFINE_PER_CPU(cpuinfo_sparc, __cpu_data) = { 0 }; |
24 | EXPORT_PER_CPU_SYMBOL(__cpu_data); | 27 | EXPORT_PER_CPU_SYMBOL(__cpu_data); |
25 | 28 | ||
29 | int ncpus_probed; | ||
30 | unsigned int fsr_storage; | ||
31 | |||
26 | struct cpu_info { | 32 | struct cpu_info { |
27 | int psr_vers; | 33 | int psr_vers; |
28 | const char *name; | 34 | const char *name; |
@@ -247,13 +253,12 @@ static const struct manufacturer_info __initconst manufacturer_info[] = { | |||
247 | * machine type value into consideration too. I will fix this. | 253 | * machine type value into consideration too. I will fix this. |
248 | */ | 254 | */ |
249 | 255 | ||
250 | const char *sparc_cpu_type; | 256 | static const char *sparc_cpu_type; |
251 | const char *sparc_fpu_type; | 257 | static const char *sparc_fpu_type; |
252 | const char *sparc_pmu_type; | 258 | const char *sparc_pmu_type; |
253 | 259 | ||
254 | unsigned int fsr_storage; | ||
255 | 260 | ||
256 | static void set_cpu_and_fpu(int psr_impl, int psr_vers, int fpu_vers) | 261 | static void __init set_cpu_and_fpu(int psr_impl, int psr_vers, int fpu_vers) |
257 | { | 262 | { |
258 | const struct manufacturer_info *manuf; | 263 | const struct manufacturer_info *manuf; |
259 | int i; | 264 | int i; |
@@ -313,7 +318,123 @@ static void set_cpu_and_fpu(int psr_impl, int psr_vers, int fpu_vers) | |||
313 | } | 318 | } |
314 | 319 | ||
315 | #ifdef CONFIG_SPARC32 | 320 | #ifdef CONFIG_SPARC32 |
316 | void __cpuinit cpu_probe(void) | 321 | static int show_cpuinfo(struct seq_file *m, void *__unused) |
322 | { | ||
323 | seq_printf(m, | ||
324 | "cpu\t\t: %s\n" | ||
325 | "fpu\t\t: %s\n" | ||
326 | "promlib\t\t: Version %d Revision %d\n" | ||
327 | "prom\t\t: %d.%d\n" | ||
328 | "type\t\t: %s\n" | ||
329 | "ncpus probed\t: %d\n" | ||
330 | "ncpus active\t: %d\n" | ||
331 | #ifndef CONFIG_SMP | ||
332 | "CPU0Bogo\t: %lu.%02lu\n" | ||
333 | "CPU0ClkTck\t: %ld\n" | ||
334 | #endif | ||
335 | , | ||
336 | sparc_cpu_type, | ||
337 | sparc_fpu_type , | ||
338 | romvec->pv_romvers, | ||
339 | prom_rev, | ||
340 | romvec->pv_printrev >> 16, | ||
341 | romvec->pv_printrev & 0xffff, | ||
342 | &cputypval[0], | ||
343 | ncpus_probed, | ||
344 | num_online_cpus() | ||
345 | #ifndef CONFIG_SMP | ||
346 | , cpu_data(0).udelay_val/(500000/HZ), | ||
347 | (cpu_data(0).udelay_val/(5000/HZ)) % 100, | ||
348 | cpu_data(0).clock_tick | ||
349 | #endif | ||
350 | ); | ||
351 | |||
352 | #ifdef CONFIG_SMP | ||
353 | smp_bogo(m); | ||
354 | #endif | ||
355 | mmu_info(m); | ||
356 | #ifdef CONFIG_SMP | ||
357 | smp_info(m); | ||
358 | #endif | ||
359 | return 0; | ||
360 | } | ||
361 | #endif /* CONFIG_SPARC32 */ | ||
362 | |||
363 | #ifdef CONFIG_SPARC64 | ||
364 | unsigned int dcache_parity_tl1_occurred; | ||
365 | unsigned int icache_parity_tl1_occurred; | ||
366 | |||
367 | |||
368 | static int show_cpuinfo(struct seq_file *m, void *__unused) | ||
369 | { | ||
370 | seq_printf(m, | ||
371 | "cpu\t\t: %s\n" | ||
372 | "fpu\t\t: %s\n" | ||
373 | "pmu\t\t: %s\n" | ||
374 | "prom\t\t: %s\n" | ||
375 | "type\t\t: %s\n" | ||
376 | "ncpus probed\t: %d\n" | ||
377 | "ncpus active\t: %d\n" | ||
378 | "D$ parity tl1\t: %u\n" | ||
379 | "I$ parity tl1\t: %u\n" | ||
380 | #ifndef CONFIG_SMP | ||
381 | "Cpu0ClkTck\t: %016lx\n" | ||
382 | #endif | ||
383 | , | ||
384 | sparc_cpu_type, | ||
385 | sparc_fpu_type, | ||
386 | sparc_pmu_type, | ||
387 | prom_version, | ||
388 | ((tlb_type == hypervisor) ? | ||
389 | "sun4v" : | ||
390 | "sun4u"), | ||
391 | ncpus_probed, | ||
392 | num_online_cpus(), | ||
393 | dcache_parity_tl1_occurred, | ||
394 | icache_parity_tl1_occurred | ||
395 | #ifndef CONFIG_SMP | ||
396 | , cpu_data(0).clock_tick | ||
397 | #endif | ||
398 | ); | ||
399 | #ifdef CONFIG_SMP | ||
400 | smp_bogo(m); | ||
401 | #endif | ||
402 | mmu_info(m); | ||
403 | #ifdef CONFIG_SMP | ||
404 | smp_info(m); | ||
405 | #endif | ||
406 | return 0; | ||
407 | } | ||
408 | #endif /* CONFIG_SPARC64 */ | ||
409 | |||
410 | static void *c_start(struct seq_file *m, loff_t *pos) | ||
411 | { | ||
412 | /* The pointer we are returning is arbitrary, | ||
413 | * it just has to be non-NULL and not IS_ERR | ||
414 | * in the success case. | ||
415 | */ | ||
416 | return *pos == 0 ? &c_start : NULL; | ||
417 | } | ||
418 | |||
419 | static void *c_next(struct seq_file *m, void *v, loff_t *pos) | ||
420 | { | ||
421 | ++*pos; | ||
422 | return c_start(m, pos); | ||
423 | } | ||
424 | |||
425 | static void c_stop(struct seq_file *m, void *v) | ||
426 | { | ||
427 | } | ||
428 | |||
429 | const struct seq_operations cpuinfo_op = { | ||
430 | .start =c_start, | ||
431 | .next = c_next, | ||
432 | .stop = c_stop, | ||
433 | .show = show_cpuinfo, | ||
434 | }; | ||
435 | |||
436 | #ifdef CONFIG_SPARC32 | ||
437 | static int __init cpu_type_probe(void) | ||
317 | { | 438 | { |
318 | int psr_impl, psr_vers, fpu_vers; | 439 | int psr_impl, psr_vers, fpu_vers; |
319 | int psr; | 440 | int psr; |
@@ -332,8 +453,12 @@ void __cpuinit cpu_probe(void) | |||
332 | put_psr(psr); | 453 | put_psr(psr); |
333 | 454 | ||
334 | set_cpu_and_fpu(psr_impl, psr_vers, fpu_vers); | 455 | set_cpu_and_fpu(psr_impl, psr_vers, fpu_vers); |
456 | |||
457 | return 0; | ||
335 | } | 458 | } |
336 | #else | 459 | #endif /* CONFIG_SPARC32 */ |
460 | |||
461 | #ifdef CONFIG_SPARC64 | ||
337 | static void __init sun4v_cpu_probe(void) | 462 | static void __init sun4v_cpu_probe(void) |
338 | { | 463 | { |
339 | switch (sun4v_chip_type) { | 464 | switch (sun4v_chip_type) { |
@@ -374,6 +499,6 @@ static int __init cpu_type_probe(void) | |||
374 | } | 499 | } |
375 | return 0; | 500 | return 0; |
376 | } | 501 | } |
502 | #endif /* CONFIG_SPARC64 */ | ||
377 | 503 | ||
378 | early_initcall(cpu_type_probe); | 504 | early_initcall(cpu_type_probe); |
379 | #endif | ||
diff --git a/arch/sparc/kernel/cpumap.c b/arch/sparc/kernel/cpumap.c index 8de64c8126bc..d91fd782743a 100644 --- a/arch/sparc/kernel/cpumap.c +++ b/arch/sparc/kernel/cpumap.c | |||
@@ -202,7 +202,7 @@ static struct cpuinfo_tree *build_cpuinfo_tree(void) | |||
202 | new_tree->total_nodes = n; | 202 | new_tree->total_nodes = n; |
203 | memcpy(&new_tree->level, tmp_level, sizeof(tmp_level)); | 203 | memcpy(&new_tree->level, tmp_level, sizeof(tmp_level)); |
204 | 204 | ||
205 | prev_cpu = cpu = first_cpu(cpu_online_map); | 205 | prev_cpu = cpu = cpumask_first(cpu_online_mask); |
206 | 206 | ||
207 | /* Initialize all levels in the tree with the first CPU */ | 207 | /* Initialize all levels in the tree with the first CPU */ |
208 | for (level = CPUINFO_LVL_PROC; level >= CPUINFO_LVL_ROOT; level--) { | 208 | for (level = CPUINFO_LVL_PROC; level >= CPUINFO_LVL_ROOT; level--) { |
@@ -381,7 +381,7 @@ static int simple_map_to_cpu(unsigned int index) | |||
381 | } | 381 | } |
382 | 382 | ||
383 | /* Impossible, since num_online_cpus() <= num_possible_cpus() */ | 383 | /* Impossible, since num_online_cpus() <= num_possible_cpus() */ |
384 | return first_cpu(cpu_online_map); | 384 | return cpumask_first(cpu_online_mask); |
385 | } | 385 | } |
386 | 386 | ||
387 | static int _map_to_cpu(unsigned int index) | 387 | static int _map_to_cpu(unsigned int index) |
diff --git a/arch/sparc/kernel/devices.c b/arch/sparc/kernel/devices.c index d2eddd6647cd..113c052c3043 100644 --- a/arch/sparc/kernel/devices.c +++ b/arch/sparc/kernel/devices.c | |||
@@ -20,7 +20,6 @@ | |||
20 | #include <asm/system.h> | 20 | #include <asm/system.h> |
21 | #include <asm/cpudata.h> | 21 | #include <asm/cpudata.h> |
22 | 22 | ||
23 | extern void cpu_probe(void); | ||
24 | extern void clock_stop_probe(void); /* tadpole.c */ | 23 | extern void clock_stop_probe(void); /* tadpole.c */ |
25 | extern void sun4c_probe_memerr_reg(void); | 24 | extern void sun4c_probe_memerr_reg(void); |
26 | 25 | ||
@@ -115,7 +114,7 @@ int cpu_get_hwmid(phandle prom_node) | |||
115 | 114 | ||
116 | void __init device_scan(void) | 115 | void __init device_scan(void) |
117 | { | 116 | { |
118 | prom_printf("Booting Linux...\n"); | 117 | printk(KERN_NOTICE "Booting Linux...\n"); |
119 | 118 | ||
120 | #ifndef CONFIG_SMP | 119 | #ifndef CONFIG_SMP |
121 | { | 120 | { |
@@ -133,7 +132,6 @@ void __init device_scan(void) | |||
133 | } | 132 | } |
134 | #endif /* !CONFIG_SMP */ | 133 | #endif /* !CONFIG_SMP */ |
135 | 134 | ||
136 | cpu_probe(); | ||
137 | { | 135 | { |
138 | extern void auxio_probe(void); | 136 | extern void auxio_probe(void); |
139 | extern void auxio_power_probe(void); | 137 | extern void auxio_power_probe(void); |
diff --git a/arch/sparc/kernel/ds.c b/arch/sparc/kernel/ds.c index 3add4de8a1a9..dd1342c0a3be 100644 --- a/arch/sparc/kernel/ds.c +++ b/arch/sparc/kernel/ds.c | |||
@@ -497,7 +497,7 @@ static void dr_cpu_init_response(struct ds_data *resp, u64 req_num, | |||
497 | tag->num_records = ncpus; | 497 | tag->num_records = ncpus; |
498 | 498 | ||
499 | i = 0; | 499 | i = 0; |
500 | for_each_cpu_mask(cpu, *mask) { | 500 | for_each_cpu(cpu, mask) { |
501 | ent[i].cpu = cpu; | 501 | ent[i].cpu = cpu; |
502 | ent[i].result = DR_CPU_RES_OK; | 502 | ent[i].result = DR_CPU_RES_OK; |
503 | ent[i].stat = default_stat; | 503 | ent[i].stat = default_stat; |
@@ -534,7 +534,7 @@ static int __cpuinit dr_cpu_configure(struct ds_info *dp, | |||
534 | int resp_len, ncpus, cpu; | 534 | int resp_len, ncpus, cpu; |
535 | unsigned long flags; | 535 | unsigned long flags; |
536 | 536 | ||
537 | ncpus = cpus_weight(*mask); | 537 | ncpus = cpumask_weight(mask); |
538 | resp_len = dr_cpu_size_response(ncpus); | 538 | resp_len = dr_cpu_size_response(ncpus); |
539 | resp = kzalloc(resp_len, GFP_KERNEL); | 539 | resp = kzalloc(resp_len, GFP_KERNEL); |
540 | if (!resp) | 540 | if (!resp) |
@@ -547,7 +547,7 @@ static int __cpuinit dr_cpu_configure(struct ds_info *dp, | |||
547 | mdesc_populate_present_mask(mask); | 547 | mdesc_populate_present_mask(mask); |
548 | mdesc_fill_in_cpu_data(mask); | 548 | mdesc_fill_in_cpu_data(mask); |
549 | 549 | ||
550 | for_each_cpu_mask(cpu, *mask) { | 550 | for_each_cpu(cpu, mask) { |
551 | int err; | 551 | int err; |
552 | 552 | ||
553 | printk(KERN_INFO "ds-%llu: Starting cpu %d...\n", | 553 | printk(KERN_INFO "ds-%llu: Starting cpu %d...\n", |
@@ -593,7 +593,7 @@ static int dr_cpu_unconfigure(struct ds_info *dp, | |||
593 | int resp_len, ncpus, cpu; | 593 | int resp_len, ncpus, cpu; |
594 | unsigned long flags; | 594 | unsigned long flags; |
595 | 595 | ||
596 | ncpus = cpus_weight(*mask); | 596 | ncpus = cpumask_weight(mask); |
597 | resp_len = dr_cpu_size_response(ncpus); | 597 | resp_len = dr_cpu_size_response(ncpus); |
598 | resp = kzalloc(resp_len, GFP_KERNEL); | 598 | resp = kzalloc(resp_len, GFP_KERNEL); |
599 | if (!resp) | 599 | if (!resp) |
@@ -603,7 +603,7 @@ static int dr_cpu_unconfigure(struct ds_info *dp, | |||
603 | resp_len, ncpus, mask, | 603 | resp_len, ncpus, mask, |
604 | DR_CPU_STAT_UNCONFIGURED); | 604 | DR_CPU_STAT_UNCONFIGURED); |
605 | 605 | ||
606 | for_each_cpu_mask(cpu, *mask) { | 606 | for_each_cpu(cpu, mask) { |
607 | int err; | 607 | int err; |
608 | 608 | ||
609 | printk(KERN_INFO "ds-%llu: Shutting down cpu %d...\n", | 609 | printk(KERN_INFO "ds-%llu: Shutting down cpu %d...\n", |
@@ -649,13 +649,13 @@ static void __cpuinit dr_cpu_data(struct ds_info *dp, | |||
649 | 649 | ||
650 | purge_dups(cpu_list, tag->num_records); | 650 | purge_dups(cpu_list, tag->num_records); |
651 | 651 | ||
652 | cpus_clear(mask); | 652 | cpumask_clear(&mask); |
653 | for (i = 0; i < tag->num_records; i++) { | 653 | for (i = 0; i < tag->num_records; i++) { |
654 | if (cpu_list[i] == CPU_SENTINEL) | 654 | if (cpu_list[i] == CPU_SENTINEL) |
655 | continue; | 655 | continue; |
656 | 656 | ||
657 | if (cpu_list[i] < nr_cpu_ids) | 657 | if (cpu_list[i] < nr_cpu_ids) |
658 | cpu_set(cpu_list[i], mask); | 658 | cpumask_set_cpu(cpu_list[i], &mask); |
659 | } | 659 | } |
660 | 660 | ||
661 | if (tag->type == DR_CPU_CONFIGURE) | 661 | if (tag->type == DR_CPU_CONFIGURE) |
diff --git a/arch/sparc/kernel/entry.S b/arch/sparc/kernel/entry.S index 6da784a5612b..8341963f4c84 100644 --- a/arch/sparc/kernel/entry.S +++ b/arch/sparc/kernel/entry.S | |||
@@ -269,19 +269,22 @@ smp4m_ticker: | |||
269 | /* Here is where we check for possible SMP IPI passed to us | 269 | /* Here is where we check for possible SMP IPI passed to us |
270 | * on some level other than 15 which is the NMI and only used | 270 | * on some level other than 15 which is the NMI and only used |
271 | * for cross calls. That has a separate entry point below. | 271 | * for cross calls. That has a separate entry point below. |
272 | * | ||
273 | * IPIs are sent on Level 12, 13 and 14. See IRQ_IPI_*. | ||
272 | */ | 274 | */ |
273 | maybe_smp4m_msg: | 275 | maybe_smp4m_msg: |
274 | GET_PROCESSOR4M_ID(o3) | 276 | GET_PROCESSOR4M_ID(o3) |
275 | sethi %hi(sun4m_irq_percpu), %l5 | 277 | sethi %hi(sun4m_irq_percpu), %l5 |
276 | sll %o3, 2, %o3 | 278 | sll %o3, 2, %o3 |
277 | or %l5, %lo(sun4m_irq_percpu), %o5 | 279 | or %l5, %lo(sun4m_irq_percpu), %o5 |
278 | sethi %hi(0x40000000), %o2 | 280 | sethi %hi(0x70000000), %o2 ! Check all soft-IRQs |
279 | ld [%o5 + %o3], %o1 | 281 | ld [%o5 + %o3], %o1 |
280 | ld [%o1 + 0x00], %o3 ! sun4m_irq_percpu[cpu]->pending | 282 | ld [%o1 + 0x00], %o3 ! sun4m_irq_percpu[cpu]->pending |
281 | andcc %o3, %o2, %g0 | 283 | andcc %o3, %o2, %g0 |
282 | be,a smp4m_ticker | 284 | be,a smp4m_ticker |
283 | cmp %l7, 14 | 285 | cmp %l7, 14 |
284 | st %o2, [%o1 + 0x04] ! sun4m_irq_percpu[cpu]->clear=0x40000000 | 286 | /* Soft-IRQ IPI */ |
287 | st %o2, [%o1 + 0x04] ! sun4m_irq_percpu[cpu]->clear=0x70000000 | ||
285 | WRITE_PAUSE | 288 | WRITE_PAUSE |
286 | ld [%o1 + 0x00], %g0 ! sun4m_irq_percpu[cpu]->pending | 289 | ld [%o1 + 0x00], %g0 ! sun4m_irq_percpu[cpu]->pending |
287 | WRITE_PAUSE | 290 | WRITE_PAUSE |
@@ -290,9 +293,27 @@ maybe_smp4m_msg: | |||
290 | WRITE_PAUSE | 293 | WRITE_PAUSE |
291 | wr %l4, PSR_ET, %psr | 294 | wr %l4, PSR_ET, %psr |
292 | WRITE_PAUSE | 295 | WRITE_PAUSE |
293 | call smp_reschedule_irq | 296 | sll %o2, 28, %o2 ! shift for simpler checks below |
297 | maybe_smp4m_msg_check_single: | ||
298 | andcc %o2, 0x1, %g0 | ||
299 | beq,a maybe_smp4m_msg_check_mask | ||
300 | andcc %o2, 0x2, %g0 | ||
301 | call smp_call_function_single_interrupt | ||
294 | nop | 302 | nop |
295 | 303 | andcc %o2, 0x2, %g0 | |
304 | maybe_smp4m_msg_check_mask: | ||
305 | beq,a maybe_smp4m_msg_check_resched | ||
306 | andcc %o2, 0x4, %g0 | ||
307 | call smp_call_function_interrupt | ||
308 | nop | ||
309 | andcc %o2, 0x4, %g0 | ||
310 | maybe_smp4m_msg_check_resched: | ||
311 | /* rescheduling is done in RESTORE_ALL regardless, but incr stats */ | ||
312 | beq,a maybe_smp4m_msg_out | ||
313 | nop | ||
314 | call smp_resched_interrupt | ||
315 | nop | ||
316 | maybe_smp4m_msg_out: | ||
296 | RESTORE_ALL | 317 | RESTORE_ALL |
297 | 318 | ||
298 | .align 4 | 319 | .align 4 |
@@ -401,18 +422,18 @@ linux_trap_ipi15_sun4d: | |||
401 | 1: b,a 1b | 422 | 1: b,a 1b |
402 | 423 | ||
403 | #ifdef CONFIG_SPARC_LEON | 424 | #ifdef CONFIG_SPARC_LEON |
404 | 425 | .globl smpleon_ipi | |
405 | .globl smpleon_ticker | 426 | .extern leon_ipi_interrupt |
406 | /* SMP per-cpu ticker interrupts are handled specially. */ | 427 | /* SMP per-cpu IPI interrupts are handled specially. */ |
407 | smpleon_ticker: | 428 | smpleon_ipi: |
408 | SAVE_ALL | 429 | SAVE_ALL |
409 | or %l0, PSR_PIL, %g2 | 430 | or %l0, PSR_PIL, %g2 |
410 | wr %g2, 0x0, %psr | 431 | wr %g2, 0x0, %psr |
411 | WRITE_PAUSE | 432 | WRITE_PAUSE |
412 | wr %g2, PSR_ET, %psr | 433 | wr %g2, PSR_ET, %psr |
413 | WRITE_PAUSE | 434 | WRITE_PAUSE |
414 | call leon_percpu_timer_interrupt | 435 | call leonsmp_ipi_interrupt |
415 | add %sp, STACKFRAME_SZ, %o0 | 436 | add %sp, STACKFRAME_SZ, %o1 ! pt_regs |
416 | wr %l0, PSR_ET, %psr | 437 | wr %l0, PSR_ET, %psr |
417 | WRITE_PAUSE | 438 | WRITE_PAUSE |
418 | RESTORE_ALL | 439 | RESTORE_ALL |
diff --git a/arch/sparc/kernel/head_32.S b/arch/sparc/kernel/head_32.S index 59423491cef8..587785759838 100644 --- a/arch/sparc/kernel/head_32.S +++ b/arch/sparc/kernel/head_32.S | |||
@@ -810,31 +810,25 @@ found_version: | |||
810 | got_prop: | 810 | got_prop: |
811 | #ifdef CONFIG_SPARC_LEON | 811 | #ifdef CONFIG_SPARC_LEON |
812 | /* no cpu-type check is needed, it is a SPARC-LEON */ | 812 | /* no cpu-type check is needed, it is a SPARC-LEON */ |
813 | #ifdef CONFIG_SMP | ||
814 | ba leon_smp_init | ||
815 | nop | ||
816 | 813 | ||
817 | .global leon_smp_init | 814 | sethi %hi(boot_cpu_id), %g2 ! boot-cpu index |
818 | leon_smp_init: | ||
819 | sethi %hi(boot_cpu_id), %g1 ! master always 0 | ||
820 | stb %g0, [%g1 + %lo(boot_cpu_id)] | ||
821 | sethi %hi(boot_cpu_id4), %g1 ! master always 0 | ||
822 | stb %g0, [%g1 + %lo(boot_cpu_id4)] | ||
823 | 815 | ||
824 | rd %asr17,%g1 | 816 | #ifdef CONFIG_SMP |
825 | srl %g1,28,%g1 | 817 | ldub [%g2 + %lo(boot_cpu_id)], %g1 |
818 | cmp %g1, 0xff ! unset means first CPU | ||
819 | bne leon_smp_cpu_startup ! continue only with master | ||
820 | nop | ||
821 | #endif | ||
822 | /* Get CPU-ID from most significant 4-bit of ASR17 */ | ||
823 | rd %asr17, %g1 | ||
824 | srl %g1, 28, %g1 | ||
826 | 825 | ||
827 | cmp %g0,%g1 | 826 | /* Update boot_cpu_id only on boot cpu */ |
828 | beq sun4c_continue_boot !continue with master | 827 | stub %g1, [%g2 + %lo(boot_cpu_id)] |
829 | nop | ||
830 | 828 | ||
831 | ba leon_smp_cpu_startup | ||
832 | nop | ||
833 | #else | ||
834 | ba sun4c_continue_boot | 829 | ba sun4c_continue_boot |
835 | nop | 830 | nop |
836 | #endif | 831 | #endif |
837 | #endif | ||
838 | set cputypval, %o2 | 832 | set cputypval, %o2 |
839 | ldub [%o2 + 0x4], %l1 | 833 | ldub [%o2 + 0x4], %l1 |
840 | 834 | ||
@@ -893,9 +887,6 @@ sun4d_init: | |||
893 | sta %g4, [%g0] ASI_M_VIKING_TMP1 | 887 | sta %g4, [%g0] ASI_M_VIKING_TMP1 |
894 | sethi %hi(boot_cpu_id), %g5 | 888 | sethi %hi(boot_cpu_id), %g5 |
895 | stb %g4, [%g5 + %lo(boot_cpu_id)] | 889 | stb %g4, [%g5 + %lo(boot_cpu_id)] |
896 | sll %g4, 2, %g4 | ||
897 | sethi %hi(boot_cpu_id4), %g5 | ||
898 | stb %g4, [%g5 + %lo(boot_cpu_id4)] | ||
899 | #endif | 890 | #endif |
900 | 891 | ||
901 | /* Fall through to sun4m_init */ | 892 | /* Fall through to sun4m_init */ |
@@ -1024,14 +1015,28 @@ sun4c_continue_boot: | |||
1024 | bl 1b | 1015 | bl 1b |
1025 | add %o0, 0x1, %o0 | 1016 | add %o0, 0x1, %o0 |
1026 | 1017 | ||
1018 | /* If boot_cpu_id has not been setup by machine specific | ||
1019 | * init-code above we default it to zero. | ||
1020 | */ | ||
1021 | sethi %hi(boot_cpu_id), %g2 | ||
1022 | ldub [%g2 + %lo(boot_cpu_id)], %g3 | ||
1023 | cmp %g3, 0xff | ||
1024 | bne 1f | ||
1025 | nop | ||
1026 | mov %g0, %g3 | ||
1027 | stub %g3, [%g2 + %lo(boot_cpu_id)] | ||
1028 | |||
1029 | 1: /* boot_cpu_id set. calculate boot_cpu_id4 = boot_cpu_id*4 */ | ||
1030 | sll %g3, 2, %g3 | ||
1031 | sethi %hi(boot_cpu_id4), %g2 | ||
1032 | stub %g3, [%g2 + %lo(boot_cpu_id4)] | ||
1033 | |||
1027 | /* Initialize the uwinmask value for init task just in case. | 1034 | /* Initialize the uwinmask value for init task just in case. |
1028 | * But first make current_set[boot_cpu_id] point to something useful. | 1035 | * But first make current_set[boot_cpu_id] point to something useful. |
1029 | */ | 1036 | */ |
1030 | set init_thread_union, %g6 | 1037 | set init_thread_union, %g6 |
1031 | set current_set, %g2 | 1038 | set current_set, %g2 |
1032 | #ifdef CONFIG_SMP | 1039 | #ifdef CONFIG_SMP |
1033 | sethi %hi(boot_cpu_id4), %g3 | ||
1034 | ldub [%g3 + %lo(boot_cpu_id4)], %g3 | ||
1035 | st %g6, [%g2] | 1040 | st %g6, [%g2] |
1036 | add %g2, %g3, %g2 | 1041 | add %g2, %g3, %g2 |
1037 | #endif | 1042 | #endif |
diff --git a/arch/sparc/kernel/ioport.c b/arch/sparc/kernel/ioport.c index c6ce9a6a4790..1c9c80a1a86a 100644 --- a/arch/sparc/kernel/ioport.c +++ b/arch/sparc/kernel/ioport.c | |||
@@ -50,10 +50,15 @@ | |||
50 | #include <asm/io-unit.h> | 50 | #include <asm/io-unit.h> |
51 | #include <asm/leon.h> | 51 | #include <asm/leon.h> |
52 | 52 | ||
53 | /* This function must make sure that caches and memory are coherent after DMA | ||
54 | * On LEON systems without cache snooping it flushes the entire D-CACHE. | ||
55 | */ | ||
53 | #ifndef CONFIG_SPARC_LEON | 56 | #ifndef CONFIG_SPARC_LEON |
54 | #define mmu_inval_dma_area(p, l) /* Anton pulled it out for 2.4.0-xx */ | 57 | static inline void dma_make_coherent(unsigned long pa, unsigned long len) |
58 | { | ||
59 | } | ||
55 | #else | 60 | #else |
56 | static inline void mmu_inval_dma_area(void *va, unsigned long len) | 61 | static inline void dma_make_coherent(unsigned long pa, unsigned long len) |
57 | { | 62 | { |
58 | if (!sparc_leon3_snooping_enabled()) | 63 | if (!sparc_leon3_snooping_enabled()) |
59 | leon_flush_dcache_all(); | 64 | leon_flush_dcache_all(); |
@@ -284,7 +289,6 @@ static void *sbus_alloc_coherent(struct device *dev, size_t len, | |||
284 | printk("sbus_alloc_consistent: cannot occupy 0x%lx", len_total); | 289 | printk("sbus_alloc_consistent: cannot occupy 0x%lx", len_total); |
285 | goto err_nova; | 290 | goto err_nova; |
286 | } | 291 | } |
287 | mmu_inval_dma_area((void *)va, len_total); | ||
288 | 292 | ||
289 | // XXX The mmu_map_dma_area does this for us below, see comments. | 293 | // XXX The mmu_map_dma_area does this for us below, see comments. |
290 | // sparc_mapiorange(0, virt_to_phys(va), res->start, len_total); | 294 | // sparc_mapiorange(0, virt_to_phys(va), res->start, len_total); |
@@ -336,7 +340,6 @@ static void sbus_free_coherent(struct device *dev, size_t n, void *p, | |||
336 | release_resource(res); | 340 | release_resource(res); |
337 | kfree(res); | 341 | kfree(res); |
338 | 342 | ||
339 | /* mmu_inval_dma_area(va, n); */ /* it's consistent, isn't it */ | ||
340 | pgv = virt_to_page(p); | 343 | pgv = virt_to_page(p); |
341 | mmu_unmap_dma_area(dev, ba, n); | 344 | mmu_unmap_dma_area(dev, ba, n); |
342 | 345 | ||
@@ -463,7 +466,6 @@ static void *pci32_alloc_coherent(struct device *dev, size_t len, | |||
463 | printk("pci_alloc_consistent: cannot occupy 0x%lx", len_total); | 466 | printk("pci_alloc_consistent: cannot occupy 0x%lx", len_total); |
464 | goto err_nova; | 467 | goto err_nova; |
465 | } | 468 | } |
466 | mmu_inval_dma_area(va, len_total); | ||
467 | sparc_mapiorange(0, virt_to_phys(va), res->start, len_total); | 469 | sparc_mapiorange(0, virt_to_phys(va), res->start, len_total); |
468 | 470 | ||
469 | *pba = virt_to_phys(va); /* equals virt_to_bus (R.I.P.) for us. */ | 471 | *pba = virt_to_phys(va); /* equals virt_to_bus (R.I.P.) for us. */ |
@@ -489,7 +491,6 @@ static void pci32_free_coherent(struct device *dev, size_t n, void *p, | |||
489 | dma_addr_t ba) | 491 | dma_addr_t ba) |
490 | { | 492 | { |
491 | struct resource *res; | 493 | struct resource *res; |
492 | void *pgp; | ||
493 | 494 | ||
494 | if ((res = _sparc_find_resource(&_sparc_dvma, | 495 | if ((res = _sparc_find_resource(&_sparc_dvma, |
495 | (unsigned long)p)) == NULL) { | 496 | (unsigned long)p)) == NULL) { |
@@ -509,14 +510,12 @@ static void pci32_free_coherent(struct device *dev, size_t n, void *p, | |||
509 | return; | 510 | return; |
510 | } | 511 | } |
511 | 512 | ||
512 | pgp = phys_to_virt(ba); /* bus_to_virt actually */ | 513 | dma_make_coherent(ba, n); |
513 | mmu_inval_dma_area(pgp, n); | ||
514 | sparc_unmapiorange((unsigned long)p, n); | 514 | sparc_unmapiorange((unsigned long)p, n); |
515 | 515 | ||
516 | release_resource(res); | 516 | release_resource(res); |
517 | kfree(res); | 517 | kfree(res); |
518 | 518 | free_pages((unsigned long)phys_to_virt(ba), get_order(n)); | |
519 | free_pages((unsigned long)pgp, get_order(n)); | ||
520 | } | 519 | } |
521 | 520 | ||
522 | /* | 521 | /* |
@@ -535,7 +534,7 @@ static void pci32_unmap_page(struct device *dev, dma_addr_t ba, size_t size, | |||
535 | enum dma_data_direction dir, struct dma_attrs *attrs) | 534 | enum dma_data_direction dir, struct dma_attrs *attrs) |
536 | { | 535 | { |
537 | if (dir != PCI_DMA_TODEVICE) | 536 | if (dir != PCI_DMA_TODEVICE) |
538 | mmu_inval_dma_area(phys_to_virt(ba), PAGE_ALIGN(size)); | 537 | dma_make_coherent(ba, PAGE_ALIGN(size)); |
539 | } | 538 | } |
540 | 539 | ||
541 | /* Map a set of buffers described by scatterlist in streaming | 540 | /* Map a set of buffers described by scatterlist in streaming |
@@ -562,8 +561,7 @@ static int pci32_map_sg(struct device *device, struct scatterlist *sgl, | |||
562 | 561 | ||
563 | /* IIep is write-through, not flushing. */ | 562 | /* IIep is write-through, not flushing. */ |
564 | for_each_sg(sgl, sg, nents, n) { | 563 | for_each_sg(sgl, sg, nents, n) { |
565 | BUG_ON(page_address(sg_page(sg)) == NULL); | 564 | sg->dma_address = sg_phys(sg); |
566 | sg->dma_address = virt_to_phys(sg_virt(sg)); | ||
567 | sg->dma_length = sg->length; | 565 | sg->dma_length = sg->length; |
568 | } | 566 | } |
569 | return nents; | 567 | return nents; |
@@ -582,9 +580,7 @@ static void pci32_unmap_sg(struct device *dev, struct scatterlist *sgl, | |||
582 | 580 | ||
583 | if (dir != PCI_DMA_TODEVICE) { | 581 | if (dir != PCI_DMA_TODEVICE) { |
584 | for_each_sg(sgl, sg, nents, n) { | 582 | for_each_sg(sgl, sg, nents, n) { |
585 | BUG_ON(page_address(sg_page(sg)) == NULL); | 583 | dma_make_coherent(sg_phys(sg), PAGE_ALIGN(sg->length)); |
586 | mmu_inval_dma_area(page_address(sg_page(sg)), | ||
587 | PAGE_ALIGN(sg->length)); | ||
588 | } | 584 | } |
589 | } | 585 | } |
590 | } | 586 | } |
@@ -603,8 +599,7 @@ static void pci32_sync_single_for_cpu(struct device *dev, dma_addr_t ba, | |||
603 | size_t size, enum dma_data_direction dir) | 599 | size_t size, enum dma_data_direction dir) |
604 | { | 600 | { |
605 | if (dir != PCI_DMA_TODEVICE) { | 601 | if (dir != PCI_DMA_TODEVICE) { |
606 | mmu_inval_dma_area(phys_to_virt(ba), | 602 | dma_make_coherent(ba, PAGE_ALIGN(size)); |
607 | PAGE_ALIGN(size)); | ||
608 | } | 603 | } |
609 | } | 604 | } |
610 | 605 | ||
@@ -612,8 +607,7 @@ static void pci32_sync_single_for_device(struct device *dev, dma_addr_t ba, | |||
612 | size_t size, enum dma_data_direction dir) | 607 | size_t size, enum dma_data_direction dir) |
613 | { | 608 | { |
614 | if (dir != PCI_DMA_TODEVICE) { | 609 | if (dir != PCI_DMA_TODEVICE) { |
615 | mmu_inval_dma_area(phys_to_virt(ba), | 610 | dma_make_coherent(ba, PAGE_ALIGN(size)); |
616 | PAGE_ALIGN(size)); | ||
617 | } | 611 | } |
618 | } | 612 | } |
619 | 613 | ||
@@ -631,9 +625,7 @@ static void pci32_sync_sg_for_cpu(struct device *dev, struct scatterlist *sgl, | |||
631 | 625 | ||
632 | if (dir != PCI_DMA_TODEVICE) { | 626 | if (dir != PCI_DMA_TODEVICE) { |
633 | for_each_sg(sgl, sg, nents, n) { | 627 | for_each_sg(sgl, sg, nents, n) { |
634 | BUG_ON(page_address(sg_page(sg)) == NULL); | 628 | dma_make_coherent(sg_phys(sg), PAGE_ALIGN(sg->length)); |
635 | mmu_inval_dma_area(page_address(sg_page(sg)), | ||
636 | PAGE_ALIGN(sg->length)); | ||
637 | } | 629 | } |
638 | } | 630 | } |
639 | } | 631 | } |
@@ -646,9 +638,7 @@ static void pci32_sync_sg_for_device(struct device *device, struct scatterlist * | |||
646 | 638 | ||
647 | if (dir != PCI_DMA_TODEVICE) { | 639 | if (dir != PCI_DMA_TODEVICE) { |
648 | for_each_sg(sgl, sg, nents, n) { | 640 | for_each_sg(sgl, sg, nents, n) { |
649 | BUG_ON(page_address(sg_page(sg)) == NULL); | 641 | dma_make_coherent(sg_phys(sg), PAGE_ALIGN(sg->length)); |
650 | mmu_inval_dma_area(page_address(sg_page(sg)), | ||
651 | PAGE_ALIGN(sg->length)); | ||
652 | } | 642 | } |
653 | } | 643 | } |
654 | } | 644 | } |
diff --git a/arch/sparc/kernel/irq.h b/arch/sparc/kernel/irq.h index 008453b798ec..100b9c204e78 100644 --- a/arch/sparc/kernel/irq.h +++ b/arch/sparc/kernel/irq.h | |||
@@ -2,6 +2,23 @@ | |||
2 | 2 | ||
3 | #include <asm/btfixup.h> | 3 | #include <asm/btfixup.h> |
4 | 4 | ||
5 | struct irq_bucket { | ||
6 | struct irq_bucket *next; | ||
7 | unsigned int real_irq; | ||
8 | unsigned int irq; | ||
9 | unsigned int pil; | ||
10 | }; | ||
11 | |||
12 | #define SUN4D_MAX_BOARD 10 | ||
13 | #define SUN4D_MAX_IRQ ((SUN4D_MAX_BOARD + 2) << 5) | ||
14 | |||
15 | /* Map between the irq identifier used in hw to the | ||
16 | * irq_bucket. The map is sufficient large to hold | ||
17 | * the sun4d hw identifiers. | ||
18 | */ | ||
19 | extern struct irq_bucket *irq_map[SUN4D_MAX_IRQ]; | ||
20 | |||
21 | |||
5 | /* sun4m specific type definitions */ | 22 | /* sun4m specific type definitions */ |
6 | 23 | ||
7 | /* This maps direct to CPU specific interrupt registers */ | 24 | /* This maps direct to CPU specific interrupt registers */ |
@@ -35,6 +52,10 @@ struct sparc_irq_config { | |||
35 | }; | 52 | }; |
36 | extern struct sparc_irq_config sparc_irq_config; | 53 | extern struct sparc_irq_config sparc_irq_config; |
37 | 54 | ||
55 | unsigned int irq_alloc(unsigned int real_irq, unsigned int pil); | ||
56 | void irq_link(unsigned int irq); | ||
57 | void irq_unlink(unsigned int irq); | ||
58 | void handler_irq(unsigned int pil, struct pt_regs *regs); | ||
38 | 59 | ||
39 | /* Dave Redman (djhr@tadpole.co.uk) | 60 | /* Dave Redman (djhr@tadpole.co.uk) |
40 | * changed these to function pointers.. it saves cycles and will allow | 61 | * changed these to function pointers.. it saves cycles and will allow |
@@ -44,33 +65,9 @@ extern struct sparc_irq_config sparc_irq_config; | |||
44 | * Changed these to btfixup entities... It saves cycles :) | 65 | * Changed these to btfixup entities... It saves cycles :) |
45 | */ | 66 | */ |
46 | 67 | ||
47 | BTFIXUPDEF_CALL(void, disable_irq, unsigned int) | ||
48 | BTFIXUPDEF_CALL(void, enable_irq, unsigned int) | ||
49 | BTFIXUPDEF_CALL(void, disable_pil_irq, unsigned int) | ||
50 | BTFIXUPDEF_CALL(void, enable_pil_irq, unsigned int) | ||
51 | BTFIXUPDEF_CALL(void, clear_clock_irq, void) | 68 | BTFIXUPDEF_CALL(void, clear_clock_irq, void) |
52 | BTFIXUPDEF_CALL(void, load_profile_irq, int, unsigned int) | 69 | BTFIXUPDEF_CALL(void, load_profile_irq, int, unsigned int) |
53 | 70 | ||
54 | static inline void __disable_irq(unsigned int irq) | ||
55 | { | ||
56 | BTFIXUP_CALL(disable_irq)(irq); | ||
57 | } | ||
58 | |||
59 | static inline void __enable_irq(unsigned int irq) | ||
60 | { | ||
61 | BTFIXUP_CALL(enable_irq)(irq); | ||
62 | } | ||
63 | |||
64 | static inline void disable_pil_irq(unsigned int irq) | ||
65 | { | ||
66 | BTFIXUP_CALL(disable_pil_irq)(irq); | ||
67 | } | ||
68 | |||
69 | static inline void enable_pil_irq(unsigned int irq) | ||
70 | { | ||
71 | BTFIXUP_CALL(enable_pil_irq)(irq); | ||
72 | } | ||
73 | |||
74 | static inline void clear_clock_irq(void) | 71 | static inline void clear_clock_irq(void) |
75 | { | 72 | { |
76 | BTFIXUP_CALL(clear_clock_irq)(); | 73 | BTFIXUP_CALL(clear_clock_irq)(); |
@@ -89,4 +86,10 @@ BTFIXUPDEF_CALL(void, set_irq_udt, int) | |||
89 | #define set_cpu_int(cpu,level) BTFIXUP_CALL(set_cpu_int)(cpu,level) | 86 | #define set_cpu_int(cpu,level) BTFIXUP_CALL(set_cpu_int)(cpu,level) |
90 | #define clear_cpu_int(cpu,level) BTFIXUP_CALL(clear_cpu_int)(cpu,level) | 87 | #define clear_cpu_int(cpu,level) BTFIXUP_CALL(clear_cpu_int)(cpu,level) |
91 | #define set_irq_udt(cpu) BTFIXUP_CALL(set_irq_udt)(cpu) | 88 | #define set_irq_udt(cpu) BTFIXUP_CALL(set_irq_udt)(cpu) |
89 | |||
90 | /* All SUN4D IPIs are sent on this IRQ, may be shared with hard IRQs */ | ||
91 | #define SUN4D_IPI_IRQ 14 | ||
92 | |||
93 | extern void sun4d_ipi_interrupt(void); | ||
94 | |||
92 | #endif | 95 | #endif |
diff --git a/arch/sparc/kernel/irq_32.c b/arch/sparc/kernel/irq_32.c index 7c93df4099cb..9b89d842913c 100644 --- a/arch/sparc/kernel/irq_32.c +++ b/arch/sparc/kernel/irq_32.c | |||
@@ -15,6 +15,7 @@ | |||
15 | #include <linux/seq_file.h> | 15 | #include <linux/seq_file.h> |
16 | 16 | ||
17 | #include <asm/cacheflush.h> | 17 | #include <asm/cacheflush.h> |
18 | #include <asm/cpudata.h> | ||
18 | #include <asm/pcic.h> | 19 | #include <asm/pcic.h> |
19 | #include <asm/leon.h> | 20 | #include <asm/leon.h> |
20 | 21 | ||
@@ -101,284 +102,173 @@ EXPORT_SYMBOL(arch_local_irq_restore); | |||
101 | * directed CPU interrupts using the existing enable/disable irq code | 102 | * directed CPU interrupts using the existing enable/disable irq code |
102 | * with tweaks. | 103 | * with tweaks. |
103 | * | 104 | * |
105 | * Sun4d complicates things even further. IRQ numbers are arbitrary | ||
106 | * 32-bit values in that case. Since this is similar to sparc64, | ||
107 | * we adopt a virtual IRQ numbering scheme as is done there. | ||
108 | * Virutal interrupt numbers are allocated by build_irq(). So NR_IRQS | ||
109 | * just becomes a limit of how many interrupt sources we can handle in | ||
110 | * a single system. Even fully loaded SS2000 machines top off at | ||
111 | * about 32 interrupt sources or so, therefore a NR_IRQS value of 64 | ||
112 | * is more than enough. | ||
113 | * | ||
114 | * We keep a map of per-PIL enable interrupts. These get wired | ||
115 | * up via the irq_chip->startup() method which gets invoked by | ||
116 | * the generic IRQ layer during request_irq(). | ||
104 | */ | 117 | */ |
105 | 118 | ||
106 | 119 | ||
120 | /* Table of allocated irqs. Unused entries has irq == 0 */ | ||
121 | static struct irq_bucket irq_table[NR_IRQS]; | ||
122 | /* Protect access to irq_table */ | ||
123 | static DEFINE_SPINLOCK(irq_table_lock); | ||
107 | 124 | ||
108 | /* | 125 | /* Map between the irq identifier used in hw to the irq_bucket. */ |
109 | * Dave Redman (djhr@tadpole.co.uk) | 126 | struct irq_bucket *irq_map[SUN4D_MAX_IRQ]; |
110 | * | 127 | /* Protect access to irq_map */ |
111 | * There used to be extern calls and hard coded values here.. very sucky! | 128 | static DEFINE_SPINLOCK(irq_map_lock); |
112 | * instead, because some of the devices attach very early, I do something | ||
113 | * equally sucky but at least we'll never try to free statically allocated | ||
114 | * space or call kmalloc before kmalloc_init :(. | ||
115 | * | ||
116 | * In fact it's the timer10 that attaches first.. then timer14 | ||
117 | * then kmalloc_init is called.. then the tty interrupts attach. | ||
118 | * hmmm.... | ||
119 | * | ||
120 | */ | ||
121 | #define MAX_STATIC_ALLOC 4 | ||
122 | struct irqaction static_irqaction[MAX_STATIC_ALLOC]; | ||
123 | int static_irq_count; | ||
124 | |||
125 | static struct { | ||
126 | struct irqaction *action; | ||
127 | int flags; | ||
128 | } sparc_irq[NR_IRQS]; | ||
129 | #define SPARC_IRQ_INPROGRESS 1 | ||
130 | |||
131 | /* Used to protect the IRQ action lists */ | ||
132 | DEFINE_SPINLOCK(irq_action_lock); | ||
133 | 129 | ||
134 | int show_interrupts(struct seq_file *p, void *v) | 130 | /* Allocate a new irq from the irq_table */ |
131 | unsigned int irq_alloc(unsigned int real_irq, unsigned int pil) | ||
135 | { | 132 | { |
136 | int i = *(loff_t *)v; | ||
137 | struct irqaction *action; | ||
138 | unsigned long flags; | 133 | unsigned long flags; |
139 | #ifdef CONFIG_SMP | 134 | unsigned int i; |
140 | int j; | 135 | |
141 | #endif | 136 | spin_lock_irqsave(&irq_table_lock, flags); |
137 | for (i = 1; i < NR_IRQS; i++) { | ||
138 | if (irq_table[i].real_irq == real_irq && irq_table[i].pil == pil) | ||
139 | goto found; | ||
140 | } | ||
142 | 141 | ||
143 | if (sparc_cpu_model == sun4d) | 142 | for (i = 1; i < NR_IRQS; i++) { |
144 | return show_sun4d_interrupts(p, v); | 143 | if (!irq_table[i].irq) |
144 | break; | ||
145 | } | ||
145 | 146 | ||
146 | spin_lock_irqsave(&irq_action_lock, flags); | ||
147 | if (i < NR_IRQS) { | 147 | if (i < NR_IRQS) { |
148 | action = sparc_irq[i].action; | 148 | irq_table[i].real_irq = real_irq; |
149 | if (!action) | 149 | irq_table[i].irq = i; |
150 | goto out_unlock; | 150 | irq_table[i].pil = pil; |
151 | seq_printf(p, "%3d: ", i); | 151 | } else { |
152 | #ifndef CONFIG_SMP | 152 | printk(KERN_ERR "IRQ: Out of virtual IRQs.\n"); |
153 | seq_printf(p, "%10u ", kstat_irqs(i)); | 153 | i = 0; |
154 | #else | ||
155 | for_each_online_cpu(j) { | ||
156 | seq_printf(p, "%10u ", | ||
157 | kstat_cpu(j).irqs[i]); | ||
158 | } | ||
159 | #endif | ||
160 | seq_printf(p, " %c %s", | ||
161 | (action->flags & IRQF_DISABLED) ? '+' : ' ', | ||
162 | action->name); | ||
163 | for (action = action->next; action; action = action->next) { | ||
164 | seq_printf(p, ",%s %s", | ||
165 | (action->flags & IRQF_DISABLED) ? " +" : "", | ||
166 | action->name); | ||
167 | } | ||
168 | seq_putc(p, '\n'); | ||
169 | } | 154 | } |
170 | out_unlock: | 155 | found: |
171 | spin_unlock_irqrestore(&irq_action_lock, flags); | 156 | spin_unlock_irqrestore(&irq_table_lock, flags); |
172 | return 0; | 157 | |
158 | return i; | ||
173 | } | 159 | } |
174 | 160 | ||
175 | void free_irq(unsigned int irq, void *dev_id) | 161 | /* Based on a single pil handler_irq may need to call several |
162 | * interrupt handlers. Use irq_map as entry to irq_table, | ||
163 | * and let each entry in irq_table point to the next entry. | ||
164 | */ | ||
165 | void irq_link(unsigned int irq) | ||
176 | { | 166 | { |
177 | struct irqaction *action; | 167 | struct irq_bucket *p; |
178 | struct irqaction **actionp; | ||
179 | unsigned long flags; | 168 | unsigned long flags; |
180 | unsigned int cpu_irq; | 169 | unsigned int pil; |
181 | |||
182 | if (sparc_cpu_model == sun4d) { | ||
183 | sun4d_free_irq(irq, dev_id); | ||
184 | return; | ||
185 | } | ||
186 | cpu_irq = irq & (NR_IRQS - 1); | ||
187 | if (cpu_irq > 14) { /* 14 irq levels on the sparc */ | ||
188 | printk(KERN_ERR "Trying to free bogus IRQ %d\n", irq); | ||
189 | return; | ||
190 | } | ||
191 | 170 | ||
192 | spin_lock_irqsave(&irq_action_lock, flags); | 171 | BUG_ON(irq >= NR_IRQS); |
193 | 172 | ||
194 | actionp = &sparc_irq[cpu_irq].action; | 173 | spin_lock_irqsave(&irq_map_lock, flags); |
195 | action = *actionp; | ||
196 | 174 | ||
197 | if (!action->handler) { | 175 | p = &irq_table[irq]; |
198 | printk(KERN_ERR "Trying to free free IRQ%d\n", irq); | 176 | pil = p->pil; |
199 | goto out_unlock; | 177 | BUG_ON(pil > SUN4D_MAX_IRQ); |
200 | } | 178 | p->next = irq_map[pil]; |
201 | if (dev_id) { | 179 | irq_map[pil] = p; |
202 | for (; action; action = action->next) { | ||
203 | if (action->dev_id == dev_id) | ||
204 | break; | ||
205 | actionp = &action->next; | ||
206 | } | ||
207 | if (!action) { | ||
208 | printk(KERN_ERR "Trying to free free shared IRQ%d\n", | ||
209 | irq); | ||
210 | goto out_unlock; | ||
211 | } | ||
212 | } else if (action->flags & IRQF_SHARED) { | ||
213 | printk(KERN_ERR "Trying to free shared IRQ%d with NULL device ID\n", | ||
214 | irq); | ||
215 | goto out_unlock; | ||
216 | } | ||
217 | if (action->flags & SA_STATIC_ALLOC) { | ||
218 | /* | ||
219 | * This interrupt is marked as specially allocated | ||
220 | * so it is a bad idea to free it. | ||
221 | */ | ||
222 | printk(KERN_ERR "Attempt to free statically allocated IRQ%d (%s)\n", | ||
223 | irq, action->name); | ||
224 | goto out_unlock; | ||
225 | } | ||
226 | |||
227 | *actionp = action->next; | ||
228 | 180 | ||
229 | spin_unlock_irqrestore(&irq_action_lock, flags); | 181 | spin_unlock_irqrestore(&irq_map_lock, flags); |
182 | } | ||
230 | 183 | ||
231 | synchronize_irq(irq); | 184 | void irq_unlink(unsigned int irq) |
185 | { | ||
186 | struct irq_bucket *p, **pnext; | ||
187 | unsigned long flags; | ||
232 | 188 | ||
233 | spin_lock_irqsave(&irq_action_lock, flags); | 189 | BUG_ON(irq >= NR_IRQS); |
234 | 190 | ||
235 | kfree(action); | 191 | spin_lock_irqsave(&irq_map_lock, flags); |
236 | 192 | ||
237 | if (!sparc_irq[cpu_irq].action) | 193 | p = &irq_table[irq]; |
238 | __disable_irq(irq); | 194 | BUG_ON(p->pil > SUN4D_MAX_IRQ); |
195 | pnext = &irq_map[p->pil]; | ||
196 | while (*pnext != p) | ||
197 | pnext = &(*pnext)->next; | ||
198 | *pnext = p->next; | ||
239 | 199 | ||
240 | out_unlock: | 200 | spin_unlock_irqrestore(&irq_map_lock, flags); |
241 | spin_unlock_irqrestore(&irq_action_lock, flags); | ||
242 | } | 201 | } |
243 | EXPORT_SYMBOL(free_irq); | ||
244 | |||
245 | /* | ||
246 | * This is called when we want to synchronize with | ||
247 | * interrupts. We may for example tell a device to | ||
248 | * stop sending interrupts: but to make sure there | ||
249 | * are no interrupts that are executing on another | ||
250 | * CPU we need to call this function. | ||
251 | */ | ||
252 | #ifdef CONFIG_SMP | ||
253 | void synchronize_irq(unsigned int irq) | ||
254 | { | ||
255 | unsigned int cpu_irq; | ||
256 | 202 | ||
257 | cpu_irq = irq & (NR_IRQS - 1); | ||
258 | while (sparc_irq[cpu_irq].flags & SPARC_IRQ_INPROGRESS) | ||
259 | cpu_relax(); | ||
260 | } | ||
261 | EXPORT_SYMBOL(synchronize_irq); | ||
262 | #endif /* SMP */ | ||
263 | 203 | ||
264 | void unexpected_irq(int irq, void *dev_id, struct pt_regs *regs) | 204 | /* /proc/interrupts printing */ |
205 | int arch_show_interrupts(struct seq_file *p, int prec) | ||
265 | { | 206 | { |
266 | int i; | 207 | int j; |
267 | struct irqaction *action; | ||
268 | unsigned int cpu_irq; | ||
269 | 208 | ||
270 | cpu_irq = irq & (NR_IRQS - 1); | 209 | #ifdef CONFIG_SMP |
271 | action = sparc_irq[cpu_irq].action; | 210 | seq_printf(p, "RES: "); |
272 | 211 | for_each_online_cpu(j) | |
273 | printk(KERN_ERR "IO device interrupt, irq = %d\n", irq); | 212 | seq_printf(p, "%10u ", cpu_data(j).irq_resched_count); |
274 | printk(KERN_ERR "PC = %08lx NPC = %08lx FP=%08lx\n", regs->pc, | 213 | seq_printf(p, " IPI rescheduling interrupts\n"); |
275 | regs->npc, regs->u_regs[14]); | 214 | seq_printf(p, "CAL: "); |
276 | if (action) { | 215 | for_each_online_cpu(j) |
277 | printk(KERN_ERR "Expecting: "); | 216 | seq_printf(p, "%10u ", cpu_data(j).irq_call_count); |
278 | for (i = 0; i < 16; i++) | 217 | seq_printf(p, " IPI function call interrupts\n"); |
279 | if (action->handler) | 218 | #endif |
280 | printk(KERN_CONT "[%s:%d:0x%x] ", action->name, | 219 | seq_printf(p, "NMI: "); |
281 | i, (unsigned int)action->handler); | 220 | for_each_online_cpu(j) |
282 | } | 221 | seq_printf(p, "%10u ", cpu_data(j).counter); |
283 | printk(KERN_ERR "AIEEE\n"); | 222 | seq_printf(p, " Non-maskable interrupts\n"); |
284 | panic("bogus interrupt received"); | 223 | return 0; |
285 | } | 224 | } |
286 | 225 | ||
287 | void handler_irq(int pil, struct pt_regs *regs) | 226 | void handler_irq(unsigned int pil, struct pt_regs *regs) |
288 | { | 227 | { |
289 | struct pt_regs *old_regs; | 228 | struct pt_regs *old_regs; |
290 | struct irqaction *action; | 229 | struct irq_bucket *p; |
291 | int cpu = smp_processor_id(); | ||
292 | 230 | ||
231 | BUG_ON(pil > 15); | ||
293 | old_regs = set_irq_regs(regs); | 232 | old_regs = set_irq_regs(regs); |
294 | irq_enter(); | 233 | irq_enter(); |
295 | disable_pil_irq(pil); | 234 | |
296 | #ifdef CONFIG_SMP | 235 | p = irq_map[pil]; |
297 | /* Only rotate on lower priority IRQs (scsi, ethernet, etc.). */ | 236 | while (p) { |
298 | if ((sparc_cpu_model==sun4m) && (pil < 10)) | 237 | struct irq_bucket *next = p->next; |
299 | smp4m_irq_rotate(cpu); | 238 | |
300 | #endif | 239 | generic_handle_irq(p->irq); |
301 | action = sparc_irq[pil].action; | 240 | p = next; |
302 | sparc_irq[pil].flags |= SPARC_IRQ_INPROGRESS; | 241 | } |
303 | kstat_cpu(cpu).irqs[pil]++; | ||
304 | do { | ||
305 | if (!action || !action->handler) | ||
306 | unexpected_irq(pil, NULL, regs); | ||
307 | action->handler(pil, action->dev_id); | ||
308 | action = action->next; | ||
309 | } while (action); | ||
310 | sparc_irq[pil].flags &= ~SPARC_IRQ_INPROGRESS; | ||
311 | enable_pil_irq(pil); | ||
312 | irq_exit(); | 242 | irq_exit(); |
313 | set_irq_regs(old_regs); | 243 | set_irq_regs(old_regs); |
314 | } | 244 | } |
315 | 245 | ||
316 | #if defined(CONFIG_BLK_DEV_FD) || defined(CONFIG_BLK_DEV_FD_MODULE) | 246 | #if defined(CONFIG_BLK_DEV_FD) || defined(CONFIG_BLK_DEV_FD_MODULE) |
247 | static unsigned int floppy_irq; | ||
317 | 248 | ||
318 | /* | 249 | int sparc_floppy_request_irq(unsigned int irq, irq_handler_t irq_handler) |
319 | * Fast IRQs on the Sparc can only have one routine attached to them, | ||
320 | * thus no sharing possible. | ||
321 | */ | ||
322 | static int request_fast_irq(unsigned int irq, | ||
323 | void (*handler)(void), | ||
324 | unsigned long irqflags, const char *devname) | ||
325 | { | 250 | { |
326 | struct irqaction *action; | ||
327 | unsigned long flags; | ||
328 | unsigned int cpu_irq; | 251 | unsigned int cpu_irq; |
329 | int ret; | 252 | int err; |
253 | |||
330 | #if defined CONFIG_SMP && !defined CONFIG_SPARC_LEON | 254 | #if defined CONFIG_SMP && !defined CONFIG_SPARC_LEON |
331 | struct tt_entry *trap_table; | 255 | struct tt_entry *trap_table; |
332 | #endif | 256 | #endif |
333 | cpu_irq = irq & (NR_IRQS - 1); | ||
334 | if (cpu_irq > 14) { | ||
335 | ret = -EINVAL; | ||
336 | goto out; | ||
337 | } | ||
338 | if (!handler) { | ||
339 | ret = -EINVAL; | ||
340 | goto out; | ||
341 | } | ||
342 | 257 | ||
343 | spin_lock_irqsave(&irq_action_lock, flags); | 258 | err = request_irq(irq, irq_handler, 0, "floppy", NULL); |
259 | if (err) | ||
260 | return -1; | ||
344 | 261 | ||
345 | action = sparc_irq[cpu_irq].action; | 262 | /* Save for later use in floppy interrupt handler */ |
346 | if (action) { | 263 | floppy_irq = irq; |
347 | if (action->flags & IRQF_SHARED) | ||
348 | panic("Trying to register fast irq when already shared.\n"); | ||
349 | if (irqflags & IRQF_SHARED) | ||
350 | panic("Trying to register fast irq as shared.\n"); | ||
351 | 264 | ||
352 | /* Anyway, someone already owns it so cannot be made fast. */ | 265 | cpu_irq = (irq & (NR_IRQS - 1)); |
353 | printk(KERN_ERR "request_fast_irq: Trying to register yet already owned.\n"); | ||
354 | ret = -EBUSY; | ||
355 | goto out_unlock; | ||
356 | } | ||
357 | |||
358 | /* | ||
359 | * If this is flagged as statically allocated then we use our | ||
360 | * private struct which is never freed. | ||
361 | */ | ||
362 | if (irqflags & SA_STATIC_ALLOC) { | ||
363 | if (static_irq_count < MAX_STATIC_ALLOC) | ||
364 | action = &static_irqaction[static_irq_count++]; | ||
365 | else | ||
366 | printk(KERN_ERR "Fast IRQ%d (%s) SA_STATIC_ALLOC failed using kmalloc\n", | ||
367 | irq, devname); | ||
368 | } | ||
369 | |||
370 | if (action == NULL) | ||
371 | action = kmalloc(sizeof(struct irqaction), GFP_ATOMIC); | ||
372 | if (!action) { | ||
373 | ret = -ENOMEM; | ||
374 | goto out_unlock; | ||
375 | } | ||
376 | 266 | ||
377 | /* Dork with trap table if we get this far. */ | 267 | /* Dork with trap table if we get this far. */ |
378 | #define INSTANTIATE(table) \ | 268 | #define INSTANTIATE(table) \ |
379 | table[SP_TRAP_IRQ1+(cpu_irq-1)].inst_one = SPARC_RD_PSR_L0; \ | 269 | table[SP_TRAP_IRQ1+(cpu_irq-1)].inst_one = SPARC_RD_PSR_L0; \ |
380 | table[SP_TRAP_IRQ1+(cpu_irq-1)].inst_two = \ | 270 | table[SP_TRAP_IRQ1+(cpu_irq-1)].inst_two = \ |
381 | SPARC_BRANCH((unsigned long) handler, \ | 271 | SPARC_BRANCH((unsigned long) floppy_hardint, \ |
382 | (unsigned long) &table[SP_TRAP_IRQ1+(cpu_irq-1)].inst_two);\ | 272 | (unsigned long) &table[SP_TRAP_IRQ1+(cpu_irq-1)].inst_two);\ |
383 | table[SP_TRAP_IRQ1+(cpu_irq-1)].inst_three = SPARC_RD_WIM_L3; \ | 273 | table[SP_TRAP_IRQ1+(cpu_irq-1)].inst_three = SPARC_RD_WIM_L3; \ |
384 | table[SP_TRAP_IRQ1+(cpu_irq-1)].inst_four = SPARC_NOP; | 274 | table[SP_TRAP_IRQ1+(cpu_irq-1)].inst_four = SPARC_NOP; |
@@ -399,22 +289,9 @@ static int request_fast_irq(unsigned int irq, | |||
399 | * writing we have no CPU-neutral interface to fine-grained flushes. | 289 | * writing we have no CPU-neutral interface to fine-grained flushes. |
400 | */ | 290 | */ |
401 | flush_cache_all(); | 291 | flush_cache_all(); |
402 | 292 | return 0; | |
403 | action->flags = irqflags; | ||
404 | action->name = devname; | ||
405 | action->dev_id = NULL; | ||
406 | action->next = NULL; | ||
407 | |||
408 | sparc_irq[cpu_irq].action = action; | ||
409 | |||
410 | __enable_irq(irq); | ||
411 | |||
412 | ret = 0; | ||
413 | out_unlock: | ||
414 | spin_unlock_irqrestore(&irq_action_lock, flags); | ||
415 | out: | ||
416 | return ret; | ||
417 | } | 293 | } |
294 | EXPORT_SYMBOL(sparc_floppy_request_irq); | ||
418 | 295 | ||
419 | /* | 296 | /* |
420 | * These variables are used to access state from the assembler | 297 | * These variables are used to access state from the assembler |
@@ -440,154 +317,23 @@ EXPORT_SYMBOL(pdma_base); | |||
440 | unsigned long pdma_areasize; | 317 | unsigned long pdma_areasize; |
441 | EXPORT_SYMBOL(pdma_areasize); | 318 | EXPORT_SYMBOL(pdma_areasize); |
442 | 319 | ||
443 | static irq_handler_t floppy_irq_handler; | 320 | /* Use the generic irq support to call floppy_interrupt |
444 | 321 | * which was setup using request_irq() in sparc_floppy_request_irq(). | |
322 | * We only have one floppy interrupt so we do not need to check | ||
323 | * for additional handlers being wired up by irq_link() | ||
324 | */ | ||
445 | void sparc_floppy_irq(int irq, void *dev_id, struct pt_regs *regs) | 325 | void sparc_floppy_irq(int irq, void *dev_id, struct pt_regs *regs) |
446 | { | 326 | { |
447 | struct pt_regs *old_regs; | 327 | struct pt_regs *old_regs; |
448 | int cpu = smp_processor_id(); | ||
449 | 328 | ||
450 | old_regs = set_irq_regs(regs); | 329 | old_regs = set_irq_regs(regs); |
451 | disable_pil_irq(irq); | ||
452 | irq_enter(); | 330 | irq_enter(); |
453 | kstat_cpu(cpu).irqs[irq]++; | 331 | generic_handle_irq(floppy_irq); |
454 | floppy_irq_handler(irq, dev_id); | ||
455 | irq_exit(); | 332 | irq_exit(); |
456 | enable_pil_irq(irq); | ||
457 | set_irq_regs(old_regs); | 333 | set_irq_regs(old_regs); |
458 | /* | ||
459 | * XXX Eek, it's totally changed with preempt_count() and such | ||
460 | * if (softirq_pending(cpu)) | ||
461 | * do_softirq(); | ||
462 | */ | ||
463 | } | ||
464 | |||
465 | int sparc_floppy_request_irq(int irq, unsigned long flags, | ||
466 | irq_handler_t irq_handler) | ||
467 | { | ||
468 | floppy_irq_handler = irq_handler; | ||
469 | return request_fast_irq(irq, floppy_hardint, flags, "floppy"); | ||
470 | } | 334 | } |
471 | EXPORT_SYMBOL(sparc_floppy_request_irq); | ||
472 | |||
473 | #endif | 335 | #endif |
474 | 336 | ||
475 | int request_irq(unsigned int irq, | ||
476 | irq_handler_t handler, | ||
477 | unsigned long irqflags, const char *devname, void *dev_id) | ||
478 | { | ||
479 | struct irqaction *action, **actionp; | ||
480 | unsigned long flags; | ||
481 | unsigned int cpu_irq; | ||
482 | int ret; | ||
483 | |||
484 | if (sparc_cpu_model == sun4d) | ||
485 | return sun4d_request_irq(irq, handler, irqflags, devname, dev_id); | ||
486 | |||
487 | cpu_irq = irq & (NR_IRQS - 1); | ||
488 | if (cpu_irq > 14) { | ||
489 | ret = -EINVAL; | ||
490 | goto out; | ||
491 | } | ||
492 | if (!handler) { | ||
493 | ret = -EINVAL; | ||
494 | goto out; | ||
495 | } | ||
496 | |||
497 | spin_lock_irqsave(&irq_action_lock, flags); | ||
498 | |||
499 | actionp = &sparc_irq[cpu_irq].action; | ||
500 | action = *actionp; | ||
501 | if (action) { | ||
502 | if (!(action->flags & IRQF_SHARED) || !(irqflags & IRQF_SHARED)) { | ||
503 | ret = -EBUSY; | ||
504 | goto out_unlock; | ||
505 | } | ||
506 | if ((action->flags & IRQF_DISABLED) != (irqflags & IRQF_DISABLED)) { | ||
507 | printk(KERN_ERR "Attempt to mix fast and slow interrupts on IRQ%d denied\n", | ||
508 | irq); | ||
509 | ret = -EBUSY; | ||
510 | goto out_unlock; | ||
511 | } | ||
512 | for ( ; action; action = *actionp) | ||
513 | actionp = &action->next; | ||
514 | } | ||
515 | |||
516 | /* If this is flagged as statically allocated then we use our | ||
517 | * private struct which is never freed. | ||
518 | */ | ||
519 | if (irqflags & SA_STATIC_ALLOC) { | ||
520 | if (static_irq_count < MAX_STATIC_ALLOC) | ||
521 | action = &static_irqaction[static_irq_count++]; | ||
522 | else | ||
523 | printk(KERN_ERR "Request for IRQ%d (%s) SA_STATIC_ALLOC failed using kmalloc\n", | ||
524 | irq, devname); | ||
525 | } | ||
526 | if (action == NULL) | ||
527 | action = kmalloc(sizeof(struct irqaction), GFP_ATOMIC); | ||
528 | if (!action) { | ||
529 | ret = -ENOMEM; | ||
530 | goto out_unlock; | ||
531 | } | ||
532 | |||
533 | action->handler = handler; | ||
534 | action->flags = irqflags; | ||
535 | action->name = devname; | ||
536 | action->next = NULL; | ||
537 | action->dev_id = dev_id; | ||
538 | |||
539 | *actionp = action; | ||
540 | |||
541 | __enable_irq(irq); | ||
542 | |||
543 | ret = 0; | ||
544 | out_unlock: | ||
545 | spin_unlock_irqrestore(&irq_action_lock, flags); | ||
546 | out: | ||
547 | return ret; | ||
548 | } | ||
549 | EXPORT_SYMBOL(request_irq); | ||
550 | |||
551 | void disable_irq_nosync(unsigned int irq) | ||
552 | { | ||
553 | __disable_irq(irq); | ||
554 | } | ||
555 | EXPORT_SYMBOL(disable_irq_nosync); | ||
556 | |||
557 | void disable_irq(unsigned int irq) | ||
558 | { | ||
559 | __disable_irq(irq); | ||
560 | } | ||
561 | EXPORT_SYMBOL(disable_irq); | ||
562 | |||
563 | void enable_irq(unsigned int irq) | ||
564 | { | ||
565 | __enable_irq(irq); | ||
566 | } | ||
567 | EXPORT_SYMBOL(enable_irq); | ||
568 | |||
569 | /* | ||
570 | * We really don't need these at all on the Sparc. We only have | ||
571 | * stubs here because they are exported to modules. | ||
572 | */ | ||
573 | unsigned long probe_irq_on(void) | ||
574 | { | ||
575 | return 0; | ||
576 | } | ||
577 | EXPORT_SYMBOL(probe_irq_on); | ||
578 | |||
579 | int probe_irq_off(unsigned long mask) | ||
580 | { | ||
581 | return 0; | ||
582 | } | ||
583 | EXPORT_SYMBOL(probe_irq_off); | ||
584 | |||
585 | static unsigned int build_device_irq(struct platform_device *op, | ||
586 | unsigned int real_irq) | ||
587 | { | ||
588 | return real_irq; | ||
589 | } | ||
590 | |||
591 | /* djhr | 337 | /* djhr |
592 | * This could probably be made indirect too and assigned in the CPU | 338 | * This could probably be made indirect too and assigned in the CPU |
593 | * bits of the code. That would be much nicer I think and would also | 339 | * bits of the code. That would be much nicer I think and would also |
@@ -598,8 +344,6 @@ static unsigned int build_device_irq(struct platform_device *op, | |||
598 | 344 | ||
599 | void __init init_IRQ(void) | 345 | void __init init_IRQ(void) |
600 | { | 346 | { |
601 | sparc_irq_config.build_device_irq = build_device_irq; | ||
602 | |||
603 | switch (sparc_cpu_model) { | 347 | switch (sparc_cpu_model) { |
604 | case sun4c: | 348 | case sun4c: |
605 | case sun4: | 349 | case sun4: |
@@ -607,14 +351,11 @@ void __init init_IRQ(void) | |||
607 | break; | 351 | break; |
608 | 352 | ||
609 | case sun4m: | 353 | case sun4m: |
610 | #ifdef CONFIG_PCI | ||
611 | pcic_probe(); | 354 | pcic_probe(); |
612 | if (pcic_present()) { | 355 | if (pcic_present()) |
613 | sun4m_pci_init_IRQ(); | 356 | sun4m_pci_init_IRQ(); |
614 | break; | 357 | else |
615 | } | 358 | sun4m_init_IRQ(); |
616 | #endif | ||
617 | sun4m_init_IRQ(); | ||
618 | break; | 359 | break; |
619 | 360 | ||
620 | case sun4d: | 361 | case sun4d: |
@@ -632,9 +373,3 @@ void __init init_IRQ(void) | |||
632 | btfixup(); | 373 | btfixup(); |
633 | } | 374 | } |
634 | 375 | ||
635 | #ifdef CONFIG_PROC_FS | ||
636 | void init_irq_proc(void) | ||
637 | { | ||
638 | /* For now, nothing... */ | ||
639 | } | ||
640 | #endif /* CONFIG_PROC_FS */ | ||
diff --git a/arch/sparc/kernel/irq_64.c b/arch/sparc/kernel/irq_64.c index b1d275ce3435..4e78862d12fd 100644 --- a/arch/sparc/kernel/irq_64.c +++ b/arch/sparc/kernel/irq_64.c | |||
@@ -224,13 +224,13 @@ static int irq_choose_cpu(unsigned int irq, const struct cpumask *affinity) | |||
224 | int cpuid; | 224 | int cpuid; |
225 | 225 | ||
226 | cpumask_copy(&mask, affinity); | 226 | cpumask_copy(&mask, affinity); |
227 | if (cpus_equal(mask, cpu_online_map)) { | 227 | if (cpumask_equal(&mask, cpu_online_mask)) { |
228 | cpuid = map_to_cpu(irq); | 228 | cpuid = map_to_cpu(irq); |
229 | } else { | 229 | } else { |
230 | cpumask_t tmp; | 230 | cpumask_t tmp; |
231 | 231 | ||
232 | cpus_and(tmp, cpu_online_map, mask); | 232 | cpumask_and(&tmp, cpu_online_mask, &mask); |
233 | cpuid = cpus_empty(tmp) ? map_to_cpu(irq) : first_cpu(tmp); | 233 | cpuid = cpumask_empty(&tmp) ? map_to_cpu(irq) : cpumask_first(&tmp); |
234 | } | 234 | } |
235 | 235 | ||
236 | return cpuid; | 236 | return cpuid; |
diff --git a/arch/sparc/kernel/kernel.h b/arch/sparc/kernel/kernel.h index 24ad449886be..6f6544cfa0ef 100644 --- a/arch/sparc/kernel/kernel.h +++ b/arch/sparc/kernel/kernel.h | |||
@@ -6,11 +6,9 @@ | |||
6 | #include <asm/traps.h> | 6 | #include <asm/traps.h> |
7 | 7 | ||
8 | /* cpu.c */ | 8 | /* cpu.c */ |
9 | extern const char *sparc_cpu_type; | ||
10 | extern const char *sparc_pmu_type; | 9 | extern const char *sparc_pmu_type; |
11 | extern const char *sparc_fpu_type; | ||
12 | |||
13 | extern unsigned int fsr_storage; | 10 | extern unsigned int fsr_storage; |
11 | extern int ncpus_probed; | ||
14 | 12 | ||
15 | #ifdef CONFIG_SPARC32 | 13 | #ifdef CONFIG_SPARC32 |
16 | /* cpu.c */ | 14 | /* cpu.c */ |
@@ -37,6 +35,7 @@ extern void sun4c_init_IRQ(void); | |||
37 | extern unsigned int lvl14_resolution; | 35 | extern unsigned int lvl14_resolution; |
38 | 36 | ||
39 | extern void sun4m_init_IRQ(void); | 37 | extern void sun4m_init_IRQ(void); |
38 | extern void sun4m_unmask_profile_irq(void); | ||
40 | extern void sun4m_clear_profile_irq(int cpu); | 39 | extern void sun4m_clear_profile_irq(int cpu); |
41 | 40 | ||
42 | /* sun4d_irq.c */ | 41 | /* sun4d_irq.c */ |
diff --git a/arch/sparc/kernel/leon_kernel.c b/arch/sparc/kernel/leon_kernel.c index 2969f777fa11..2f538ac2e139 100644 --- a/arch/sparc/kernel/leon_kernel.c +++ b/arch/sparc/kernel/leon_kernel.c | |||
@@ -19,53 +19,70 @@ | |||
19 | #include <asm/leon_amba.h> | 19 | #include <asm/leon_amba.h> |
20 | #include <asm/traps.h> | 20 | #include <asm/traps.h> |
21 | #include <asm/cacheflush.h> | 21 | #include <asm/cacheflush.h> |
22 | #include <asm/smp.h> | ||
23 | #include <asm/setup.h> | ||
22 | 24 | ||
23 | #include "prom.h" | 25 | #include "prom.h" |
24 | #include "irq.h" | 26 | #include "irq.h" |
25 | 27 | ||
26 | struct leon3_irqctrl_regs_map *leon3_irqctrl_regs; /* interrupt controller base address */ | 28 | struct leon3_irqctrl_regs_map *leon3_irqctrl_regs; /* interrupt controller base address */ |
27 | struct leon3_gptimer_regs_map *leon3_gptimer_regs; /* timer controller base address */ | 29 | struct leon3_gptimer_regs_map *leon3_gptimer_regs; /* timer controller base address */ |
28 | struct amba_apb_device leon_percpu_timer_dev[16]; | ||
29 | 30 | ||
30 | int leondebug_irq_disable; | 31 | int leondebug_irq_disable; |
31 | int leon_debug_irqout; | 32 | int leon_debug_irqout; |
32 | static int dummy_master_l10_counter; | 33 | static int dummy_master_l10_counter; |
33 | unsigned long amba_system_id; | 34 | unsigned long amba_system_id; |
35 | static DEFINE_SPINLOCK(leon_irq_lock); | ||
34 | 36 | ||
35 | unsigned long leon3_gptimer_irq; /* interrupt controller irq number */ | 37 | unsigned long leon3_gptimer_irq; /* interrupt controller irq number */ |
36 | unsigned long leon3_gptimer_idx; /* Timer Index (0..6) within Timer Core */ | 38 | unsigned long leon3_gptimer_idx; /* Timer Index (0..6) within Timer Core */ |
39 | int leon3_ticker_irq; /* Timer ticker IRQ */ | ||
37 | unsigned int sparc_leon_eirq; | 40 | unsigned int sparc_leon_eirq; |
38 | #define LEON_IMASK ((&leon3_irqctrl_regs->mask[0])) | 41 | #define LEON_IMASK(cpu) (&leon3_irqctrl_regs->mask[cpu]) |
42 | #define LEON_IACK (&leon3_irqctrl_regs->iclear) | ||
43 | #define LEON_DO_ACK_HW 1 | ||
39 | 44 | ||
40 | /* Return the IRQ of the pending IRQ on the extended IRQ controller */ | 45 | /* Return the last ACKed IRQ by the Extended IRQ controller. It has already |
41 | int sparc_leon_eirq_get(int eirq, int cpu) | 46 | * been (automatically) ACKed when the CPU takes the trap. |
47 | */ | ||
48 | static inline unsigned int leon_eirq_get(int cpu) | ||
42 | { | 49 | { |
43 | return LEON3_BYPASS_LOAD_PA(&leon3_irqctrl_regs->intid[cpu]) & 0x1f; | 50 | return LEON3_BYPASS_LOAD_PA(&leon3_irqctrl_regs->intid[cpu]) & 0x1f; |
44 | } | 51 | } |
45 | 52 | ||
46 | irqreturn_t sparc_leon_eirq_isr(int dummy, void *dev_id) | 53 | /* Handle one or multiple IRQs from the extended interrupt controller */ |
54 | static void leon_handle_ext_irq(unsigned int irq, struct irq_desc *desc) | ||
47 | { | 55 | { |
48 | printk(KERN_ERR "sparc_leon_eirq_isr: ERROR EXTENDED IRQ\n"); | 56 | unsigned int eirq; |
49 | return IRQ_HANDLED; | 57 | int cpu = sparc_leon3_cpuid(); |
58 | |||
59 | eirq = leon_eirq_get(cpu); | ||
60 | if ((eirq & 0x10) && irq_map[eirq]->irq) /* bit4 tells if IRQ happened */ | ||
61 | generic_handle_irq(irq_map[eirq]->irq); | ||
50 | } | 62 | } |
51 | 63 | ||
52 | /* The extended IRQ controller has been found, this function registers it */ | 64 | /* The extended IRQ controller has been found, this function registers it */ |
53 | void sparc_leon_eirq_register(int eirq) | 65 | void leon_eirq_setup(unsigned int eirq) |
54 | { | 66 | { |
55 | int irq; | 67 | unsigned long mask, oldmask; |
68 | unsigned int veirq; | ||
56 | 69 | ||
57 | /* Register a "BAD" handler for this interrupt, it should never happen */ | 70 | if (eirq < 1 || eirq > 0xf) { |
58 | irq = request_irq(eirq, sparc_leon_eirq_isr, | 71 | printk(KERN_ERR "LEON EXT IRQ NUMBER BAD: %d\n", eirq); |
59 | (IRQF_DISABLED | SA_STATIC_ALLOC), "extirq", NULL); | 72 | return; |
60 | |||
61 | if (irq) { | ||
62 | printk(KERN_ERR | ||
63 | "sparc_leon_eirq_register: unable to attach IRQ%d\n", | ||
64 | eirq); | ||
65 | } else { | ||
66 | sparc_leon_eirq = eirq; | ||
67 | } | 73 | } |
68 | 74 | ||
75 | veirq = leon_build_device_irq(eirq, leon_handle_ext_irq, "extirq", 0); | ||
76 | |||
77 | /* | ||
78 | * Unmask the Extended IRQ, the IRQs routed through the Ext-IRQ | ||
79 | * controller have a mask-bit of their own, so this is safe. | ||
80 | */ | ||
81 | irq_link(veirq); | ||
82 | mask = 1 << eirq; | ||
83 | oldmask = LEON3_BYPASS_LOAD_PA(LEON_IMASK(boot_cpu_id)); | ||
84 | LEON3_BYPASS_STORE_PA(LEON_IMASK(boot_cpu_id), (oldmask | mask)); | ||
85 | sparc_leon_eirq = eirq; | ||
69 | } | 86 | } |
70 | 87 | ||
71 | static inline unsigned long get_irqmask(unsigned int irq) | 88 | static inline unsigned long get_irqmask(unsigned int irq) |
@@ -83,35 +100,151 @@ static inline unsigned long get_irqmask(unsigned int irq) | |||
83 | return mask; | 100 | return mask; |
84 | } | 101 | } |
85 | 102 | ||
86 | static void leon_enable_irq(unsigned int irq_nr) | 103 | #ifdef CONFIG_SMP |
104 | static int irq_choose_cpu(const struct cpumask *affinity) | ||
87 | { | 105 | { |
88 | unsigned long mask, flags; | 106 | cpumask_t mask; |
89 | mask = get_irqmask(irq_nr); | 107 | |
90 | local_irq_save(flags); | 108 | cpus_and(mask, cpu_online_map, *affinity); |
91 | LEON3_BYPASS_STORE_PA(LEON_IMASK, | 109 | if (cpus_equal(mask, cpu_online_map) || cpus_empty(mask)) |
92 | (LEON3_BYPASS_LOAD_PA(LEON_IMASK) | (mask))); | 110 | return boot_cpu_id; |
93 | local_irq_restore(flags); | 111 | else |
112 | return first_cpu(mask); | ||
94 | } | 113 | } |
114 | #else | ||
115 | #define irq_choose_cpu(affinity) boot_cpu_id | ||
116 | #endif | ||
95 | 117 | ||
96 | static void leon_disable_irq(unsigned int irq_nr) | 118 | static int leon_set_affinity(struct irq_data *data, const struct cpumask *dest, |
119 | bool force) | ||
97 | { | 120 | { |
98 | unsigned long mask, flags; | 121 | unsigned long mask, oldmask, flags; |
99 | mask = get_irqmask(irq_nr); | 122 | int oldcpu, newcpu; |
100 | local_irq_save(flags); | 123 | |
101 | LEON3_BYPASS_STORE_PA(LEON_IMASK, | 124 | mask = (unsigned long)data->chip_data; |
102 | (LEON3_BYPASS_LOAD_PA(LEON_IMASK) & ~(mask))); | 125 | oldcpu = irq_choose_cpu(data->affinity); |
103 | local_irq_restore(flags); | 126 | newcpu = irq_choose_cpu(dest); |
127 | |||
128 | if (oldcpu == newcpu) | ||
129 | goto out; | ||
130 | |||
131 | /* unmask on old CPU first before enabling on the selected CPU */ | ||
132 | spin_lock_irqsave(&leon_irq_lock, flags); | ||
133 | oldmask = LEON3_BYPASS_LOAD_PA(LEON_IMASK(oldcpu)); | ||
134 | LEON3_BYPASS_STORE_PA(LEON_IMASK(oldcpu), (oldmask & ~mask)); | ||
135 | oldmask = LEON3_BYPASS_LOAD_PA(LEON_IMASK(newcpu)); | ||
136 | LEON3_BYPASS_STORE_PA(LEON_IMASK(newcpu), (oldmask | mask)); | ||
137 | spin_unlock_irqrestore(&leon_irq_lock, flags); | ||
138 | out: | ||
139 | return IRQ_SET_MASK_OK; | ||
140 | } | ||
141 | |||
142 | static void leon_unmask_irq(struct irq_data *data) | ||
143 | { | ||
144 | unsigned long mask, oldmask, flags; | ||
145 | int cpu; | ||
146 | |||
147 | mask = (unsigned long)data->chip_data; | ||
148 | cpu = irq_choose_cpu(data->affinity); | ||
149 | spin_lock_irqsave(&leon_irq_lock, flags); | ||
150 | oldmask = LEON3_BYPASS_LOAD_PA(LEON_IMASK(cpu)); | ||
151 | LEON3_BYPASS_STORE_PA(LEON_IMASK(cpu), (oldmask | mask)); | ||
152 | spin_unlock_irqrestore(&leon_irq_lock, flags); | ||
153 | } | ||
154 | |||
155 | static void leon_mask_irq(struct irq_data *data) | ||
156 | { | ||
157 | unsigned long mask, oldmask, flags; | ||
158 | int cpu; | ||
159 | |||
160 | mask = (unsigned long)data->chip_data; | ||
161 | cpu = irq_choose_cpu(data->affinity); | ||
162 | spin_lock_irqsave(&leon_irq_lock, flags); | ||
163 | oldmask = LEON3_BYPASS_LOAD_PA(LEON_IMASK(cpu)); | ||
164 | LEON3_BYPASS_STORE_PA(LEON_IMASK(cpu), (oldmask & ~mask)); | ||
165 | spin_unlock_irqrestore(&leon_irq_lock, flags); | ||
166 | } | ||
167 | |||
168 | static unsigned int leon_startup_irq(struct irq_data *data) | ||
169 | { | ||
170 | irq_link(data->irq); | ||
171 | leon_unmask_irq(data); | ||
172 | return 0; | ||
173 | } | ||
104 | 174 | ||
175 | static void leon_shutdown_irq(struct irq_data *data) | ||
176 | { | ||
177 | leon_mask_irq(data); | ||
178 | irq_unlink(data->irq); | ||
179 | } | ||
180 | |||
181 | /* Used by external level sensitive IRQ handlers on the LEON: ACK IRQ ctrl */ | ||
182 | static void leon_eoi_irq(struct irq_data *data) | ||
183 | { | ||
184 | unsigned long mask = (unsigned long)data->chip_data; | ||
185 | |||
186 | if (mask & LEON_DO_ACK_HW) | ||
187 | LEON3_BYPASS_STORE_PA(LEON_IACK, mask & ~LEON_DO_ACK_HW); | ||
188 | } | ||
189 | |||
190 | static struct irq_chip leon_irq = { | ||
191 | .name = "leon", | ||
192 | .irq_startup = leon_startup_irq, | ||
193 | .irq_shutdown = leon_shutdown_irq, | ||
194 | .irq_mask = leon_mask_irq, | ||
195 | .irq_unmask = leon_unmask_irq, | ||
196 | .irq_eoi = leon_eoi_irq, | ||
197 | .irq_set_affinity = leon_set_affinity, | ||
198 | }; | ||
199 | |||
200 | /* | ||
201 | * Build a LEON IRQ for the edge triggered LEON IRQ controller: | ||
202 | * Edge (normal) IRQ - handle_simple_irq, ack=DONT-CARE, never ack | ||
203 | * Level IRQ (PCI|Level-GPIO) - handle_fasteoi_irq, ack=1, ack after ISR | ||
204 | * Per-CPU Edge - handle_percpu_irq, ack=0 | ||
205 | */ | ||
206 | unsigned int leon_build_device_irq(unsigned int real_irq, | ||
207 | irq_flow_handler_t flow_handler, | ||
208 | const char *name, int do_ack) | ||
209 | { | ||
210 | unsigned int irq; | ||
211 | unsigned long mask; | ||
212 | |||
213 | irq = 0; | ||
214 | mask = get_irqmask(real_irq); | ||
215 | if (mask == 0) | ||
216 | goto out; | ||
217 | |||
218 | irq = irq_alloc(real_irq, real_irq); | ||
219 | if (irq == 0) | ||
220 | goto out; | ||
221 | |||
222 | if (do_ack) | ||
223 | mask |= LEON_DO_ACK_HW; | ||
224 | |||
225 | irq_set_chip_and_handler_name(irq, &leon_irq, | ||
226 | flow_handler, name); | ||
227 | irq_set_chip_data(irq, (void *)mask); | ||
228 | |||
229 | out: | ||
230 | return irq; | ||
231 | } | ||
232 | |||
233 | static unsigned int _leon_build_device_irq(struct platform_device *op, | ||
234 | unsigned int real_irq) | ||
235 | { | ||
236 | return leon_build_device_irq(real_irq, handle_simple_irq, "edge", 0); | ||
105 | } | 237 | } |
106 | 238 | ||
107 | void __init leon_init_timers(irq_handler_t counter_fn) | 239 | void __init leon_init_timers(irq_handler_t counter_fn) |
108 | { | 240 | { |
109 | int irq; | 241 | int irq, eirq; |
110 | struct device_node *rootnp, *np, *nnp; | 242 | struct device_node *rootnp, *np, *nnp; |
111 | struct property *pp; | 243 | struct property *pp; |
112 | int len; | 244 | int len; |
113 | int cpu, icsel; | 245 | int icsel; |
114 | int ampopts; | 246 | int ampopts; |
247 | int err; | ||
115 | 248 | ||
116 | leondebug_irq_disable = 0; | 249 | leondebug_irq_disable = 0; |
117 | leon_debug_irqout = 0; | 250 | leon_debug_irqout = 0; |
@@ -173,98 +306,85 @@ void __init leon_init_timers(irq_handler_t counter_fn) | |||
173 | leon3_gptimer_irq = *(unsigned int *)pp->value; | 306 | leon3_gptimer_irq = *(unsigned int *)pp->value; |
174 | } while (0); | 307 | } while (0); |
175 | 308 | ||
176 | if (leon3_gptimer_regs && leon3_irqctrl_regs && leon3_gptimer_irq) { | 309 | if (!(leon3_gptimer_regs && leon3_irqctrl_regs && leon3_gptimer_irq)) |
177 | LEON3_BYPASS_STORE_PA( | 310 | goto bad; |
178 | &leon3_gptimer_regs->e[leon3_gptimer_idx].val, 0); | 311 | |
179 | LEON3_BYPASS_STORE_PA( | 312 | LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx].val, 0); |
180 | &leon3_gptimer_regs->e[leon3_gptimer_idx].rld, | 313 | LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx].rld, |
181 | (((1000000 / HZ) - 1))); | 314 | (((1000000 / HZ) - 1))); |
182 | LEON3_BYPASS_STORE_PA( | 315 | LEON3_BYPASS_STORE_PA( |
183 | &leon3_gptimer_regs->e[leon3_gptimer_idx].ctrl, 0); | 316 | &leon3_gptimer_regs->e[leon3_gptimer_idx].ctrl, 0); |
184 | 317 | ||
185 | #ifdef CONFIG_SMP | 318 | #ifdef CONFIG_SMP |
186 | leon_percpu_timer_dev[0].start = (int)leon3_gptimer_regs; | 319 | leon3_ticker_irq = leon3_gptimer_irq + 1 + leon3_gptimer_idx; |
187 | leon_percpu_timer_dev[0].irq = leon3_gptimer_irq + 1 + | ||
188 | leon3_gptimer_idx; | ||
189 | |||
190 | if (!(LEON3_BYPASS_LOAD_PA(&leon3_gptimer_regs->config) & | ||
191 | (1<<LEON3_GPTIMER_SEPIRQ))) { | ||
192 | prom_printf("irq timer not configured with separate irqs\n"); | ||
193 | BUG(); | ||
194 | } | ||
195 | 320 | ||
196 | LEON3_BYPASS_STORE_PA( | 321 | if (!(LEON3_BYPASS_LOAD_PA(&leon3_gptimer_regs->config) & |
197 | &leon3_gptimer_regs->e[leon3_gptimer_idx+1].val, 0); | 322 | (1<<LEON3_GPTIMER_SEPIRQ))) { |
198 | LEON3_BYPASS_STORE_PA( | 323 | printk(KERN_ERR "timer not configured with separate irqs\n"); |
199 | &leon3_gptimer_regs->e[leon3_gptimer_idx+1].rld, | 324 | BUG(); |
200 | (((1000000/HZ) - 1))); | ||
201 | LEON3_BYPASS_STORE_PA( | ||
202 | &leon3_gptimer_regs->e[leon3_gptimer_idx+1].ctrl, 0); | ||
203 | # endif | ||
204 | |||
205 | /* | ||
206 | * The IRQ controller may (if implemented) consist of multiple | ||
207 | * IRQ controllers, each mapped on a 4Kb boundary. | ||
208 | * Each CPU may be routed to different IRQCTRLs, however | ||
209 | * we assume that all CPUs (in SMP system) is routed to the | ||
210 | * same IRQ Controller, and for non-SMP only one IRQCTRL is | ||
211 | * accessed anyway. | ||
212 | * In AMP systems, Linux must run on CPU0 for the time being. | ||
213 | */ | ||
214 | cpu = sparc_leon3_cpuid(); | ||
215 | icsel = LEON3_BYPASS_LOAD_PA(&leon3_irqctrl_regs->icsel[cpu/8]); | ||
216 | icsel = (icsel >> ((7 - (cpu&0x7)) * 4)) & 0xf; | ||
217 | leon3_irqctrl_regs += icsel; | ||
218 | } else { | ||
219 | goto bad; | ||
220 | } | 325 | } |
221 | 326 | ||
222 | irq = request_irq(leon3_gptimer_irq+leon3_gptimer_idx, | 327 | LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx+1].val, |
223 | counter_fn, | 328 | 0); |
224 | (IRQF_DISABLED | SA_STATIC_ALLOC), "timer", NULL); | 329 | LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx+1].rld, |
330 | (((1000000/HZ) - 1))); | ||
331 | LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx+1].ctrl, | ||
332 | 0); | ||
333 | #endif | ||
225 | 334 | ||
226 | if (irq) { | 335 | /* |
227 | printk(KERN_ERR "leon_time_init: unable to attach IRQ%d\n", | 336 | * The IRQ controller may (if implemented) consist of multiple |
228 | LEON_INTERRUPT_TIMER1); | 337 | * IRQ controllers, each mapped on a 4Kb boundary. |
338 | * Each CPU may be routed to different IRQCTRLs, however | ||
339 | * we assume that all CPUs (in SMP system) is routed to the | ||
340 | * same IRQ Controller, and for non-SMP only one IRQCTRL is | ||
341 | * accessed anyway. | ||
342 | * In AMP systems, Linux must run on CPU0 for the time being. | ||
343 | */ | ||
344 | icsel = LEON3_BYPASS_LOAD_PA(&leon3_irqctrl_regs->icsel[boot_cpu_id/8]); | ||
345 | icsel = (icsel >> ((7 - (boot_cpu_id&0x7)) * 4)) & 0xf; | ||
346 | leon3_irqctrl_regs += icsel; | ||
347 | |||
348 | /* Mask all IRQs on boot-cpu IRQ controller */ | ||
349 | LEON3_BYPASS_STORE_PA(&leon3_irqctrl_regs->mask[boot_cpu_id], 0); | ||
350 | |||
351 | /* Probe extended IRQ controller */ | ||
352 | eirq = (LEON3_BYPASS_LOAD_PA(&leon3_irqctrl_regs->mpstatus) | ||
353 | >> 16) & 0xf; | ||
354 | if (eirq != 0) | ||
355 | leon_eirq_setup(eirq); | ||
356 | |||
357 | irq = _leon_build_device_irq(NULL, leon3_gptimer_irq+leon3_gptimer_idx); | ||
358 | err = request_irq(irq, counter_fn, IRQF_TIMER, "timer", NULL); | ||
359 | if (err) { | ||
360 | printk(KERN_ERR "unable to attach timer IRQ%d\n", irq); | ||
229 | prom_halt(); | 361 | prom_halt(); |
230 | } | 362 | } |
231 | 363 | ||
232 | # ifdef CONFIG_SMP | 364 | LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx].ctrl, |
233 | { | 365 | LEON3_GPTIMER_EN | |
234 | unsigned long flags; | 366 | LEON3_GPTIMER_RL | |
235 | struct tt_entry *trap_table = &sparc_ttable[SP_TRAP_IRQ1 + (leon_percpu_timer_dev[0].irq - 1)]; | 367 | LEON3_GPTIMER_LD | |
236 | 368 | LEON3_GPTIMER_IRQEN); | |
237 | /* For SMP we use the level 14 ticker, however the bootup code | ||
238 | * has copied the firmwares level 14 vector into boot cpu's | ||
239 | * trap table, we must fix this now or we get squashed. | ||
240 | */ | ||
241 | local_irq_save(flags); | ||
242 | |||
243 | patchme_maybe_smp_msg[0] = 0x01000000; /* NOP out the branch */ | ||
244 | |||
245 | /* Adjust so that we jump directly to smpleon_ticker */ | ||
246 | trap_table->inst_three += smpleon_ticker - real_irq_entry; | ||
247 | 369 | ||
248 | local_flush_cache_all(); | 370 | #ifdef CONFIG_SMP |
249 | local_irq_restore(flags); | 371 | /* Install per-cpu IRQ handler for broadcasted ticker */ |
372 | irq = leon_build_device_irq(leon3_ticker_irq, handle_percpu_irq, | ||
373 | "per-cpu", 0); | ||
374 | err = request_irq(irq, leon_percpu_timer_interrupt, | ||
375 | IRQF_PERCPU | IRQF_TIMER, "ticker", | ||
376 | NULL); | ||
377 | if (err) { | ||
378 | printk(KERN_ERR "unable to attach ticker IRQ%d\n", irq); | ||
379 | prom_halt(); | ||
250 | } | 380 | } |
251 | # endif | ||
252 | |||
253 | if (leon3_gptimer_regs) { | ||
254 | LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx].ctrl, | ||
255 | LEON3_GPTIMER_EN | | ||
256 | LEON3_GPTIMER_RL | | ||
257 | LEON3_GPTIMER_LD | LEON3_GPTIMER_IRQEN); | ||
258 | 381 | ||
259 | #ifdef CONFIG_SMP | 382 | LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx+1].ctrl, |
260 | LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx+1].ctrl, | 383 | LEON3_GPTIMER_EN | |
261 | LEON3_GPTIMER_EN | | 384 | LEON3_GPTIMER_RL | |
262 | LEON3_GPTIMER_RL | | 385 | LEON3_GPTIMER_LD | |
263 | LEON3_GPTIMER_LD | | 386 | LEON3_GPTIMER_IRQEN); |
264 | LEON3_GPTIMER_IRQEN); | ||
265 | #endif | 387 | #endif |
266 | |||
267 | } | ||
268 | return; | 388 | return; |
269 | bad: | 389 | bad: |
270 | printk(KERN_ERR "No Timer/irqctrl found\n"); | 390 | printk(KERN_ERR "No Timer/irqctrl found\n"); |
@@ -281,9 +401,6 @@ void leon_load_profile_irq(int cpu, unsigned int limit) | |||
281 | BUG(); | 401 | BUG(); |
282 | } | 402 | } |
283 | 403 | ||
284 | |||
285 | |||
286 | |||
287 | void __init leon_trans_init(struct device_node *dp) | 404 | void __init leon_trans_init(struct device_node *dp) |
288 | { | 405 | { |
289 | if (strcmp(dp->type, "cpu") == 0 && strcmp(dp->name, "<NULL>") == 0) { | 406 | if (strcmp(dp->type, "cpu") == 0 && strcmp(dp->name, "<NULL>") == 0) { |
@@ -337,22 +454,18 @@ void leon_enable_irq_cpu(unsigned int irq_nr, unsigned int cpu) | |||
337 | { | 454 | { |
338 | unsigned long mask, flags, *addr; | 455 | unsigned long mask, flags, *addr; |
339 | mask = get_irqmask(irq_nr); | 456 | mask = get_irqmask(irq_nr); |
340 | local_irq_save(flags); | 457 | spin_lock_irqsave(&leon_irq_lock, flags); |
341 | addr = (unsigned long *)&(leon3_irqctrl_regs->mask[cpu]); | 458 | addr = (unsigned long *)LEON_IMASK(cpu); |
342 | LEON3_BYPASS_STORE_PA(addr, (LEON3_BYPASS_LOAD_PA(addr) | (mask))); | 459 | LEON3_BYPASS_STORE_PA(addr, (LEON3_BYPASS_LOAD_PA(addr) | mask)); |
343 | local_irq_restore(flags); | 460 | spin_unlock_irqrestore(&leon_irq_lock, flags); |
344 | } | 461 | } |
345 | 462 | ||
346 | #endif | 463 | #endif |
347 | 464 | ||
348 | void __init leon_init_IRQ(void) | 465 | void __init leon_init_IRQ(void) |
349 | { | 466 | { |
350 | sparc_irq_config.init_timers = leon_init_timers; | 467 | sparc_irq_config.init_timers = leon_init_timers; |
351 | 468 | sparc_irq_config.build_device_irq = _leon_build_device_irq; | |
352 | BTFIXUPSET_CALL(enable_irq, leon_enable_irq, BTFIXUPCALL_NORM); | ||
353 | BTFIXUPSET_CALL(disable_irq, leon_disable_irq, BTFIXUPCALL_NORM); | ||
354 | BTFIXUPSET_CALL(enable_pil_irq, leon_enable_irq, BTFIXUPCALL_NORM); | ||
355 | BTFIXUPSET_CALL(disable_pil_irq, leon_disable_irq, BTFIXUPCALL_NORM); | ||
356 | 469 | ||
357 | BTFIXUPSET_CALL(clear_clock_irq, leon_clear_clock_irq, | 470 | BTFIXUPSET_CALL(clear_clock_irq, leon_clear_clock_irq, |
358 | BTFIXUPCALL_NORM); | 471 | BTFIXUPCALL_NORM); |
diff --git a/arch/sparc/kernel/leon_smp.c b/arch/sparc/kernel/leon_smp.c index 8f5de4aa3c0a..fe8fb44c609c 100644 --- a/arch/sparc/kernel/leon_smp.c +++ b/arch/sparc/kernel/leon_smp.c | |||
@@ -14,6 +14,7 @@ | |||
14 | #include <linux/smp.h> | 14 | #include <linux/smp.h> |
15 | #include <linux/interrupt.h> | 15 | #include <linux/interrupt.h> |
16 | #include <linux/kernel_stat.h> | 16 | #include <linux/kernel_stat.h> |
17 | #include <linux/of.h> | ||
17 | #include <linux/init.h> | 18 | #include <linux/init.h> |
18 | #include <linux/spinlock.h> | 19 | #include <linux/spinlock.h> |
19 | #include <linux/mm.h> | 20 | #include <linux/mm.h> |
@@ -29,6 +30,7 @@ | |||
29 | #include <asm/ptrace.h> | 30 | #include <asm/ptrace.h> |
30 | #include <asm/atomic.h> | 31 | #include <asm/atomic.h> |
31 | #include <asm/irq_regs.h> | 32 | #include <asm/irq_regs.h> |
33 | #include <asm/traps.h> | ||
32 | 34 | ||
33 | #include <asm/delay.h> | 35 | #include <asm/delay.h> |
34 | #include <asm/irq.h> | 36 | #include <asm/irq.h> |
@@ -50,9 +52,12 @@ | |||
50 | extern ctxd_t *srmmu_ctx_table_phys; | 52 | extern ctxd_t *srmmu_ctx_table_phys; |
51 | static int smp_processors_ready; | 53 | static int smp_processors_ready; |
52 | extern volatile unsigned long cpu_callin_map[NR_CPUS]; | 54 | extern volatile unsigned long cpu_callin_map[NR_CPUS]; |
53 | extern unsigned char boot_cpu_id; | ||
54 | extern cpumask_t smp_commenced_mask; | 55 | extern cpumask_t smp_commenced_mask; |
55 | void __init leon_configure_cache_smp(void); | 56 | void __init leon_configure_cache_smp(void); |
57 | static void leon_ipi_init(void); | ||
58 | |||
59 | /* IRQ number of LEON IPIs */ | ||
60 | int leon_ipi_irq = LEON3_IRQ_IPI_DEFAULT; | ||
56 | 61 | ||
57 | static inline unsigned long do_swap(volatile unsigned long *ptr, | 62 | static inline unsigned long do_swap(volatile unsigned long *ptr, |
58 | unsigned long val) | 63 | unsigned long val) |
@@ -94,8 +99,6 @@ void __cpuinit leon_callin(void) | |||
94 | local_flush_cache_all(); | 99 | local_flush_cache_all(); |
95 | local_flush_tlb_all(); | 100 | local_flush_tlb_all(); |
96 | 101 | ||
97 | cpu_probe(); | ||
98 | |||
99 | /* Fix idle thread fields. */ | 102 | /* Fix idle thread fields. */ |
100 | __asm__ __volatile__("ld [%0], %%g6\n\t" : : "r"(¤t_set[cpuid]) | 103 | __asm__ __volatile__("ld [%0], %%g6\n\t" : : "r"(¤t_set[cpuid]) |
101 | : "memory" /* paranoid */); | 104 | : "memory" /* paranoid */); |
@@ -104,11 +107,11 @@ void __cpuinit leon_callin(void) | |||
104 | atomic_inc(&init_mm.mm_count); | 107 | atomic_inc(&init_mm.mm_count); |
105 | current->active_mm = &init_mm; | 108 | current->active_mm = &init_mm; |
106 | 109 | ||
107 | while (!cpu_isset(cpuid, smp_commenced_mask)) | 110 | while (!cpumask_test_cpu(cpuid, &smp_commenced_mask)) |
108 | mb(); | 111 | mb(); |
109 | 112 | ||
110 | local_irq_enable(); | 113 | local_irq_enable(); |
111 | cpu_set(cpuid, cpu_online_map); | 114 | set_cpu_online(cpuid, true); |
112 | } | 115 | } |
113 | 116 | ||
114 | /* | 117 | /* |
@@ -179,13 +182,16 @@ void __init leon_boot_cpus(void) | |||
179 | int nrcpu = leon_smp_nrcpus(); | 182 | int nrcpu = leon_smp_nrcpus(); |
180 | int me = smp_processor_id(); | 183 | int me = smp_processor_id(); |
181 | 184 | ||
185 | /* Setup IPI */ | ||
186 | leon_ipi_init(); | ||
187 | |||
182 | printk(KERN_INFO "%d:(%d:%d) cpus mpirq at 0x%x\n", (unsigned int)me, | 188 | printk(KERN_INFO "%d:(%d:%d) cpus mpirq at 0x%x\n", (unsigned int)me, |
183 | (unsigned int)nrcpu, (unsigned int)NR_CPUS, | 189 | (unsigned int)nrcpu, (unsigned int)NR_CPUS, |
184 | (unsigned int)&(leon3_irqctrl_regs->mpstatus)); | 190 | (unsigned int)&(leon3_irqctrl_regs->mpstatus)); |
185 | 191 | ||
186 | leon_enable_irq_cpu(LEON3_IRQ_CROSS_CALL, me); | 192 | leon_enable_irq_cpu(LEON3_IRQ_CROSS_CALL, me); |
187 | leon_enable_irq_cpu(LEON3_IRQ_TICKER, me); | 193 | leon_enable_irq_cpu(LEON3_IRQ_TICKER, me); |
188 | leon_enable_irq_cpu(LEON3_IRQ_RESCHEDULE, me); | 194 | leon_enable_irq_cpu(leon_ipi_irq, me); |
189 | 195 | ||
190 | leon_smp_setbroadcast(1 << LEON3_IRQ_TICKER); | 196 | leon_smp_setbroadcast(1 << LEON3_IRQ_TICKER); |
191 | 197 | ||
@@ -220,6 +226,10 @@ int __cpuinit leon_boot_one_cpu(int i) | |||
220 | (unsigned int)&leon3_irqctrl_regs->mpstatus); | 226 | (unsigned int)&leon3_irqctrl_regs->mpstatus); |
221 | local_flush_cache_all(); | 227 | local_flush_cache_all(); |
222 | 228 | ||
229 | /* Make sure all IRQs are of from the start for this new CPU */ | ||
230 | LEON_BYPASS_STORE_PA(&leon3_irqctrl_regs->mask[i], 0); | ||
231 | |||
232 | /* Wake one CPU */ | ||
223 | LEON_BYPASS_STORE_PA(&(leon3_irqctrl_regs->mpstatus), 1 << i); | 233 | LEON_BYPASS_STORE_PA(&(leon3_irqctrl_regs->mpstatus), 1 << i); |
224 | 234 | ||
225 | /* wheee... it's going... */ | 235 | /* wheee... it's going... */ |
@@ -236,7 +246,7 @@ int __cpuinit leon_boot_one_cpu(int i) | |||
236 | } else { | 246 | } else { |
237 | leon_enable_irq_cpu(LEON3_IRQ_CROSS_CALL, i); | 247 | leon_enable_irq_cpu(LEON3_IRQ_CROSS_CALL, i); |
238 | leon_enable_irq_cpu(LEON3_IRQ_TICKER, i); | 248 | leon_enable_irq_cpu(LEON3_IRQ_TICKER, i); |
239 | leon_enable_irq_cpu(LEON3_IRQ_RESCHEDULE, i); | 249 | leon_enable_irq_cpu(leon_ipi_irq, i); |
240 | } | 250 | } |
241 | 251 | ||
242 | local_flush_cache_all(); | 252 | local_flush_cache_all(); |
@@ -262,21 +272,21 @@ void __init leon_smp_done(void) | |||
262 | local_flush_cache_all(); | 272 | local_flush_cache_all(); |
263 | 273 | ||
264 | /* Free unneeded trap tables */ | 274 | /* Free unneeded trap tables */ |
265 | if (!cpu_isset(1, cpu_present_map)) { | 275 | if (!cpu_present(1)) { |
266 | ClearPageReserved(virt_to_page(&trapbase_cpu1)); | 276 | ClearPageReserved(virt_to_page(&trapbase_cpu1)); |
267 | init_page_count(virt_to_page(&trapbase_cpu1)); | 277 | init_page_count(virt_to_page(&trapbase_cpu1)); |
268 | free_page((unsigned long)&trapbase_cpu1); | 278 | free_page((unsigned long)&trapbase_cpu1); |
269 | totalram_pages++; | 279 | totalram_pages++; |
270 | num_physpages++; | 280 | num_physpages++; |
271 | } | 281 | } |
272 | if (!cpu_isset(2, cpu_present_map)) { | 282 | if (!cpu_present(2)) { |
273 | ClearPageReserved(virt_to_page(&trapbase_cpu2)); | 283 | ClearPageReserved(virt_to_page(&trapbase_cpu2)); |
274 | init_page_count(virt_to_page(&trapbase_cpu2)); | 284 | init_page_count(virt_to_page(&trapbase_cpu2)); |
275 | free_page((unsigned long)&trapbase_cpu2); | 285 | free_page((unsigned long)&trapbase_cpu2); |
276 | totalram_pages++; | 286 | totalram_pages++; |
277 | num_physpages++; | 287 | num_physpages++; |
278 | } | 288 | } |
279 | if (!cpu_isset(3, cpu_present_map)) { | 289 | if (!cpu_present(3)) { |
280 | ClearPageReserved(virt_to_page(&trapbase_cpu3)); | 290 | ClearPageReserved(virt_to_page(&trapbase_cpu3)); |
281 | init_page_count(virt_to_page(&trapbase_cpu3)); | 291 | init_page_count(virt_to_page(&trapbase_cpu3)); |
282 | free_page((unsigned long)&trapbase_cpu3); | 292 | free_page((unsigned long)&trapbase_cpu3); |
@@ -292,6 +302,99 @@ void leon_irq_rotate(int cpu) | |||
292 | { | 302 | { |
293 | } | 303 | } |
294 | 304 | ||
305 | struct leon_ipi_work { | ||
306 | int single; | ||
307 | int msk; | ||
308 | int resched; | ||
309 | }; | ||
310 | |||
311 | static DEFINE_PER_CPU_SHARED_ALIGNED(struct leon_ipi_work, leon_ipi_work); | ||
312 | |||
313 | /* Initialize IPIs on the LEON, in order to save IRQ resources only one IRQ | ||
314 | * is used for all three types of IPIs. | ||
315 | */ | ||
316 | static void __init leon_ipi_init(void) | ||
317 | { | ||
318 | int cpu, len; | ||
319 | struct leon_ipi_work *work; | ||
320 | struct property *pp; | ||
321 | struct device_node *rootnp; | ||
322 | struct tt_entry *trap_table; | ||
323 | unsigned long flags; | ||
324 | |||
325 | /* Find IPI IRQ or stick with default value */ | ||
326 | rootnp = of_find_node_by_path("/ambapp0"); | ||
327 | if (rootnp) { | ||
328 | pp = of_find_property(rootnp, "ipi_num", &len); | ||
329 | if (pp && (*(int *)pp->value)) | ||
330 | leon_ipi_irq = *(int *)pp->value; | ||
331 | } | ||
332 | printk(KERN_INFO "leon: SMP IPIs at IRQ %d\n", leon_ipi_irq); | ||
333 | |||
334 | /* Adjust so that we jump directly to smpleon_ipi */ | ||
335 | local_irq_save(flags); | ||
336 | trap_table = &sparc_ttable[SP_TRAP_IRQ1 + (leon_ipi_irq - 1)]; | ||
337 | trap_table->inst_three += smpleon_ipi - real_irq_entry; | ||
338 | local_flush_cache_all(); | ||
339 | local_irq_restore(flags); | ||
340 | |||
341 | for_each_possible_cpu(cpu) { | ||
342 | work = &per_cpu(leon_ipi_work, cpu); | ||
343 | work->single = work->msk = work->resched = 0; | ||
344 | } | ||
345 | } | ||
346 | |||
347 | static void leon_ipi_single(int cpu) | ||
348 | { | ||
349 | struct leon_ipi_work *work = &per_cpu(leon_ipi_work, cpu); | ||
350 | |||
351 | /* Mark work */ | ||
352 | work->single = 1; | ||
353 | |||
354 | /* Generate IRQ on the CPU */ | ||
355 | set_cpu_int(cpu, leon_ipi_irq); | ||
356 | } | ||
357 | |||
358 | static void leon_ipi_mask_one(int cpu) | ||
359 | { | ||
360 | struct leon_ipi_work *work = &per_cpu(leon_ipi_work, cpu); | ||
361 | |||
362 | /* Mark work */ | ||
363 | work->msk = 1; | ||
364 | |||
365 | /* Generate IRQ on the CPU */ | ||
366 | set_cpu_int(cpu, leon_ipi_irq); | ||
367 | } | ||
368 | |||
369 | static void leon_ipi_resched(int cpu) | ||
370 | { | ||
371 | struct leon_ipi_work *work = &per_cpu(leon_ipi_work, cpu); | ||
372 | |||
373 | /* Mark work */ | ||
374 | work->resched = 1; | ||
375 | |||
376 | /* Generate IRQ on the CPU (any IRQ will cause resched) */ | ||
377 | set_cpu_int(cpu, leon_ipi_irq); | ||
378 | } | ||
379 | |||
380 | void leonsmp_ipi_interrupt(void) | ||
381 | { | ||
382 | struct leon_ipi_work *work = &__get_cpu_var(leon_ipi_work); | ||
383 | |||
384 | if (work->single) { | ||
385 | work->single = 0; | ||
386 | smp_call_function_single_interrupt(); | ||
387 | } | ||
388 | if (work->msk) { | ||
389 | work->msk = 0; | ||
390 | smp_call_function_interrupt(); | ||
391 | } | ||
392 | if (work->resched) { | ||
393 | work->resched = 0; | ||
394 | smp_resched_interrupt(); | ||
395 | } | ||
396 | } | ||
397 | |||
295 | static struct smp_funcall { | 398 | static struct smp_funcall { |
296 | smpfunc_t func; | 399 | smpfunc_t func; |
297 | unsigned long arg1; | 400 | unsigned long arg1; |
@@ -337,10 +440,10 @@ static void leon_cross_call(smpfunc_t func, cpumask_t mask, unsigned long arg1, | |||
337 | { | 440 | { |
338 | register int i; | 441 | register int i; |
339 | 442 | ||
340 | cpu_clear(smp_processor_id(), mask); | 443 | cpumask_clear_cpu(smp_processor_id(), &mask); |
341 | cpus_and(mask, cpu_online_map, mask); | 444 | cpumask_and(&mask, cpu_online_mask, &mask); |
342 | for (i = 0; i <= high; i++) { | 445 | for (i = 0; i <= high; i++) { |
343 | if (cpu_isset(i, mask)) { | 446 | if (cpumask_test_cpu(i, &mask)) { |
344 | ccall_info.processors_in[i] = 0; | 447 | ccall_info.processors_in[i] = 0; |
345 | ccall_info.processors_out[i] = 0; | 448 | ccall_info.processors_out[i] = 0; |
346 | set_cpu_int(i, LEON3_IRQ_CROSS_CALL); | 449 | set_cpu_int(i, LEON3_IRQ_CROSS_CALL); |
@@ -354,7 +457,7 @@ static void leon_cross_call(smpfunc_t func, cpumask_t mask, unsigned long arg1, | |||
354 | 457 | ||
355 | i = 0; | 458 | i = 0; |
356 | do { | 459 | do { |
357 | if (!cpu_isset(i, mask)) | 460 | if (!cpumask_test_cpu(i, &mask)) |
358 | continue; | 461 | continue; |
359 | 462 | ||
360 | while (!ccall_info.processors_in[i]) | 463 | while (!ccall_info.processors_in[i]) |
@@ -363,7 +466,7 @@ static void leon_cross_call(smpfunc_t func, cpumask_t mask, unsigned long arg1, | |||
363 | 466 | ||
364 | i = 0; | 467 | i = 0; |
365 | do { | 468 | do { |
366 | if (!cpu_isset(i, mask)) | 469 | if (!cpumask_test_cpu(i, &mask)) |
367 | continue; | 470 | continue; |
368 | 471 | ||
369 | while (!ccall_info.processors_out[i]) | 472 | while (!ccall_info.processors_out[i]) |
@@ -386,27 +489,23 @@ void leon_cross_call_irq(void) | |||
386 | ccall_info.processors_out[i] = 1; | 489 | ccall_info.processors_out[i] = 1; |
387 | } | 490 | } |
388 | 491 | ||
389 | void leon_percpu_timer_interrupt(struct pt_regs *regs) | 492 | irqreturn_t leon_percpu_timer_interrupt(int irq, void *unused) |
390 | { | 493 | { |
391 | struct pt_regs *old_regs; | ||
392 | int cpu = smp_processor_id(); | 494 | int cpu = smp_processor_id(); |
393 | 495 | ||
394 | old_regs = set_irq_regs(regs); | ||
395 | |||
396 | leon_clear_profile_irq(cpu); | 496 | leon_clear_profile_irq(cpu); |
397 | 497 | ||
398 | profile_tick(CPU_PROFILING); | 498 | profile_tick(CPU_PROFILING); |
399 | 499 | ||
400 | if (!--prof_counter(cpu)) { | 500 | if (!--prof_counter(cpu)) { |
401 | int user = user_mode(regs); | 501 | int user = user_mode(get_irq_regs()); |
402 | 502 | ||
403 | irq_enter(); | ||
404 | update_process_times(user); | 503 | update_process_times(user); |
405 | irq_exit(); | ||
406 | 504 | ||
407 | prof_counter(cpu) = prof_multiplier(cpu); | 505 | prof_counter(cpu) = prof_multiplier(cpu); |
408 | } | 506 | } |
409 | set_irq_regs(old_regs); | 507 | |
508 | return IRQ_HANDLED; | ||
410 | } | 509 | } |
411 | 510 | ||
412 | static void __init smp_setup_percpu_timer(void) | 511 | static void __init smp_setup_percpu_timer(void) |
@@ -449,6 +548,9 @@ void __init leon_init_smp(void) | |||
449 | BTFIXUPSET_CALL(smp_cross_call, leon_cross_call, BTFIXUPCALL_NORM); | 548 | BTFIXUPSET_CALL(smp_cross_call, leon_cross_call, BTFIXUPCALL_NORM); |
450 | BTFIXUPSET_CALL(__hard_smp_processor_id, __leon_processor_id, | 549 | BTFIXUPSET_CALL(__hard_smp_processor_id, __leon_processor_id, |
451 | BTFIXUPCALL_NORM); | 550 | BTFIXUPCALL_NORM); |
551 | BTFIXUPSET_CALL(smp_ipi_resched, leon_ipi_resched, BTFIXUPCALL_NORM); | ||
552 | BTFIXUPSET_CALL(smp_ipi_single, leon_ipi_single, BTFIXUPCALL_NORM); | ||
553 | BTFIXUPSET_CALL(smp_ipi_mask_one, leon_ipi_mask_one, BTFIXUPCALL_NORM); | ||
452 | } | 554 | } |
453 | 555 | ||
454 | #endif /* CONFIG_SPARC_LEON */ | 556 | #endif /* CONFIG_SPARC_LEON */ |
diff --git a/arch/sparc/kernel/mdesc.c b/arch/sparc/kernel/mdesc.c index 56db06432ce9..42f28c7420e1 100644 --- a/arch/sparc/kernel/mdesc.c +++ b/arch/sparc/kernel/mdesc.c | |||
@@ -768,7 +768,7 @@ static void * __cpuinit mdesc_iterate_over_cpus(void *(*func)(struct mdesc_handl | |||
768 | cpuid, NR_CPUS); | 768 | cpuid, NR_CPUS); |
769 | continue; | 769 | continue; |
770 | } | 770 | } |
771 | if (!cpu_isset(cpuid, *mask)) | 771 | if (!cpumask_test_cpu(cpuid, mask)) |
772 | continue; | 772 | continue; |
773 | #endif | 773 | #endif |
774 | 774 | ||
diff --git a/arch/sparc/kernel/of_device_64.c b/arch/sparc/kernel/of_device_64.c index 5c149689bb20..3bb2eace58cf 100644 --- a/arch/sparc/kernel/of_device_64.c +++ b/arch/sparc/kernel/of_device_64.c | |||
@@ -622,8 +622,9 @@ static unsigned int __init build_one_device_irq(struct platform_device *op, | |||
622 | out: | 622 | out: |
623 | nid = of_node_to_nid(dp); | 623 | nid = of_node_to_nid(dp); |
624 | if (nid != -1) { | 624 | if (nid != -1) { |
625 | cpumask_t numa_mask = *cpumask_of_node(nid); | 625 | cpumask_t numa_mask; |
626 | 626 | ||
627 | cpumask_copy(&numa_mask, cpumask_of_node(nid)); | ||
627 | irq_set_affinity(irq, &numa_mask); | 628 | irq_set_affinity(irq, &numa_mask); |
628 | } | 629 | } |
629 | 630 | ||
diff --git a/arch/sparc/kernel/pci_msi.c b/arch/sparc/kernel/pci_msi.c index 30982e9ab626..580651af73f2 100644 --- a/arch/sparc/kernel/pci_msi.c +++ b/arch/sparc/kernel/pci_msi.c | |||
@@ -284,8 +284,9 @@ static int bringup_one_msi_queue(struct pci_pbm_info *pbm, | |||
284 | 284 | ||
285 | nid = pbm->numa_node; | 285 | nid = pbm->numa_node; |
286 | if (nid != -1) { | 286 | if (nid != -1) { |
287 | cpumask_t numa_mask = *cpumask_of_node(nid); | 287 | cpumask_t numa_mask; |
288 | 288 | ||
289 | cpumask_copy(&numa_mask, cpumask_of_node(nid)); | ||
289 | irq_set_affinity(irq, &numa_mask); | 290 | irq_set_affinity(irq, &numa_mask); |
290 | } | 291 | } |
291 | err = request_irq(irq, sparc64_msiq_interrupt, 0, | 292 | err = request_irq(irq, sparc64_msiq_interrupt, 0, |
diff --git a/arch/sparc/kernel/pcic.c b/arch/sparc/kernel/pcic.c index 2cdc131b50ac..948601a066ff 100644 --- a/arch/sparc/kernel/pcic.c +++ b/arch/sparc/kernel/pcic.c | |||
@@ -164,6 +164,9 @@ void __iomem *pcic_regs; | |||
164 | volatile int pcic_speculative; | 164 | volatile int pcic_speculative; |
165 | volatile int pcic_trapped; | 165 | volatile int pcic_trapped; |
166 | 166 | ||
167 | /* forward */ | ||
168 | unsigned int pcic_build_device_irq(struct platform_device *op, | ||
169 | unsigned int real_irq); | ||
167 | 170 | ||
168 | #define CONFIG_CMD(bus, device_fn, where) (0x80000000 | (((unsigned int)bus) << 16) | (((unsigned int)device_fn) << 8) | (where & ~3)) | 171 | #define CONFIG_CMD(bus, device_fn, where) (0x80000000 | (((unsigned int)bus) << 16) | (((unsigned int)device_fn) << 8) | (where & ~3)) |
169 | 172 | ||
@@ -523,6 +526,7 @@ static void | |||
523 | pcic_fill_irq(struct linux_pcic *pcic, struct pci_dev *dev, int node) | 526 | pcic_fill_irq(struct linux_pcic *pcic, struct pci_dev *dev, int node) |
524 | { | 527 | { |
525 | struct pcic_ca2irq *p; | 528 | struct pcic_ca2irq *p; |
529 | unsigned int real_irq; | ||
526 | int i, ivec; | 530 | int i, ivec; |
527 | char namebuf[64]; | 531 | char namebuf[64]; |
528 | 532 | ||
@@ -551,26 +555,25 @@ pcic_fill_irq(struct linux_pcic *pcic, struct pci_dev *dev, int node) | |||
551 | i = p->pin; | 555 | i = p->pin; |
552 | if (i >= 0 && i < 4) { | 556 | if (i >= 0 && i < 4) { |
553 | ivec = readw(pcic->pcic_regs+PCI_INT_SELECT_LO); | 557 | ivec = readw(pcic->pcic_regs+PCI_INT_SELECT_LO); |
554 | dev->irq = ivec >> (i << 2) & 0xF; | 558 | real_irq = ivec >> (i << 2) & 0xF; |
555 | } else if (i >= 4 && i < 8) { | 559 | } else if (i >= 4 && i < 8) { |
556 | ivec = readw(pcic->pcic_regs+PCI_INT_SELECT_HI); | 560 | ivec = readw(pcic->pcic_regs+PCI_INT_SELECT_HI); |
557 | dev->irq = ivec >> ((i-4) << 2) & 0xF; | 561 | real_irq = ivec >> ((i-4) << 2) & 0xF; |
558 | } else { /* Corrupted map */ | 562 | } else { /* Corrupted map */ |
559 | printk("PCIC: BAD PIN %d\n", i); for (;;) {} | 563 | printk("PCIC: BAD PIN %d\n", i); for (;;) {} |
560 | } | 564 | } |
561 | /* P3 */ /* printk("PCIC: device %s pin %d ivec 0x%x irq %x\n", namebuf, i, ivec, dev->irq); */ | 565 | /* P3 */ /* printk("PCIC: device %s pin %d ivec 0x%x irq %x\n", namebuf, i, ivec, dev->irq); */ |
562 | 566 | ||
563 | /* | 567 | /* real_irq means PROM did not bother to program the upper |
564 | * dev->irq=0 means PROM did not bother to program the upper | ||
565 | * half of PCIC. This happens on JS-E with PROM 3.11, for instance. | 568 | * half of PCIC. This happens on JS-E with PROM 3.11, for instance. |
566 | */ | 569 | */ |
567 | if (dev->irq == 0 || p->force) { | 570 | if (real_irq == 0 || p->force) { |
568 | if (p->irq == 0 || p->irq >= 15) { /* Corrupted map */ | 571 | if (p->irq == 0 || p->irq >= 15) { /* Corrupted map */ |
569 | printk("PCIC: BAD IRQ %d\n", p->irq); for (;;) {} | 572 | printk("PCIC: BAD IRQ %d\n", p->irq); for (;;) {} |
570 | } | 573 | } |
571 | printk("PCIC: setting irq %d at pin %d for device %02x:%02x\n", | 574 | printk("PCIC: setting irq %d at pin %d for device %02x:%02x\n", |
572 | p->irq, p->pin, dev->bus->number, dev->devfn); | 575 | p->irq, p->pin, dev->bus->number, dev->devfn); |
573 | dev->irq = p->irq; | 576 | real_irq = p->irq; |
574 | 577 | ||
575 | i = p->pin; | 578 | i = p->pin; |
576 | if (i >= 4) { | 579 | if (i >= 4) { |
@@ -584,7 +587,8 @@ pcic_fill_irq(struct linux_pcic *pcic, struct pci_dev *dev, int node) | |||
584 | ivec |= p->irq << (i << 2); | 587 | ivec |= p->irq << (i << 2); |
585 | writew(ivec, pcic->pcic_regs+PCI_INT_SELECT_LO); | 588 | writew(ivec, pcic->pcic_regs+PCI_INT_SELECT_LO); |
586 | } | 589 | } |
587 | } | 590 | } |
591 | dev->irq = pcic_build_device_irq(NULL, real_irq); | ||
588 | } | 592 | } |
589 | 593 | ||
590 | /* | 594 | /* |
@@ -729,6 +733,7 @@ void __init pci_time_init(void) | |||
729 | struct linux_pcic *pcic = &pcic0; | 733 | struct linux_pcic *pcic = &pcic0; |
730 | unsigned long v; | 734 | unsigned long v; |
731 | int timer_irq, irq; | 735 | int timer_irq, irq; |
736 | int err; | ||
732 | 737 | ||
733 | do_arch_gettimeoffset = pci_gettimeoffset; | 738 | do_arch_gettimeoffset = pci_gettimeoffset; |
734 | 739 | ||
@@ -740,9 +745,10 @@ void __init pci_time_init(void) | |||
740 | timer_irq = PCI_COUNTER_IRQ_SYS(v); | 745 | timer_irq = PCI_COUNTER_IRQ_SYS(v); |
741 | writel (PCI_COUNTER_IRQ_SET(timer_irq, 0), | 746 | writel (PCI_COUNTER_IRQ_SET(timer_irq, 0), |
742 | pcic->pcic_regs+PCI_COUNTER_IRQ); | 747 | pcic->pcic_regs+PCI_COUNTER_IRQ); |
743 | irq = request_irq(timer_irq, pcic_timer_handler, | 748 | irq = pcic_build_device_irq(NULL, timer_irq); |
744 | (IRQF_DISABLED | SA_STATIC_ALLOC), "timer", NULL); | 749 | err = request_irq(irq, pcic_timer_handler, |
745 | if (irq) { | 750 | IRQF_TIMER, "timer", NULL); |
751 | if (err) { | ||
746 | prom_printf("time_init: unable to attach IRQ%d\n", timer_irq); | 752 | prom_printf("time_init: unable to attach IRQ%d\n", timer_irq); |
747 | prom_halt(); | 753 | prom_halt(); |
748 | } | 754 | } |
@@ -803,50 +809,73 @@ static inline unsigned long get_irqmask(int irq_nr) | |||
803 | return 1 << irq_nr; | 809 | return 1 << irq_nr; |
804 | } | 810 | } |
805 | 811 | ||
806 | static void pcic_disable_irq(unsigned int irq_nr) | 812 | static void pcic_mask_irq(struct irq_data *data) |
807 | { | 813 | { |
808 | unsigned long mask, flags; | 814 | unsigned long mask, flags; |
809 | 815 | ||
810 | mask = get_irqmask(irq_nr); | 816 | mask = (unsigned long)data->chip_data; |
811 | local_irq_save(flags); | 817 | local_irq_save(flags); |
812 | writel(mask, pcic0.pcic_regs+PCI_SYS_INT_TARGET_MASK_SET); | 818 | writel(mask, pcic0.pcic_regs+PCI_SYS_INT_TARGET_MASK_SET); |
813 | local_irq_restore(flags); | 819 | local_irq_restore(flags); |
814 | } | 820 | } |
815 | 821 | ||
816 | static void pcic_enable_irq(unsigned int irq_nr) | 822 | static void pcic_unmask_irq(struct irq_data *data) |
817 | { | 823 | { |
818 | unsigned long mask, flags; | 824 | unsigned long mask, flags; |
819 | 825 | ||
820 | mask = get_irqmask(irq_nr); | 826 | mask = (unsigned long)data->chip_data; |
821 | local_irq_save(flags); | 827 | local_irq_save(flags); |
822 | writel(mask, pcic0.pcic_regs+PCI_SYS_INT_TARGET_MASK_CLEAR); | 828 | writel(mask, pcic0.pcic_regs+PCI_SYS_INT_TARGET_MASK_CLEAR); |
823 | local_irq_restore(flags); | 829 | local_irq_restore(flags); |
824 | } | 830 | } |
825 | 831 | ||
826 | static void pcic_load_profile_irq(int cpu, unsigned int limit) | 832 | static unsigned int pcic_startup_irq(struct irq_data *data) |
827 | { | 833 | { |
828 | printk("PCIC: unimplemented code: FILE=%s LINE=%d", __FILE__, __LINE__); | 834 | irq_link(data->irq); |
835 | pcic_unmask_irq(data); | ||
836 | return 0; | ||
829 | } | 837 | } |
830 | 838 | ||
831 | /* We assume the caller has disabled local interrupts when these are called, | 839 | static struct irq_chip pcic_irq = { |
832 | * or else very bizarre behavior will result. | 840 | .name = "pcic", |
833 | */ | 841 | .irq_startup = pcic_startup_irq, |
834 | static void pcic_disable_pil_irq(unsigned int pil) | 842 | .irq_mask = pcic_mask_irq, |
843 | .irq_unmask = pcic_unmask_irq, | ||
844 | }; | ||
845 | |||
846 | unsigned int pcic_build_device_irq(struct platform_device *op, | ||
847 | unsigned int real_irq) | ||
835 | { | 848 | { |
836 | writel(get_irqmask(pil), pcic0.pcic_regs+PCI_SYS_INT_TARGET_MASK_SET); | 849 | unsigned int irq; |
850 | unsigned long mask; | ||
851 | |||
852 | irq = 0; | ||
853 | mask = get_irqmask(real_irq); | ||
854 | if (mask == 0) | ||
855 | goto out; | ||
856 | |||
857 | irq = irq_alloc(real_irq, real_irq); | ||
858 | if (irq == 0) | ||
859 | goto out; | ||
860 | |||
861 | irq_set_chip_and_handler_name(irq, &pcic_irq, | ||
862 | handle_level_irq, "PCIC"); | ||
863 | irq_set_chip_data(irq, (void *)mask); | ||
864 | |||
865 | out: | ||
866 | return irq; | ||
837 | } | 867 | } |
838 | 868 | ||
839 | static void pcic_enable_pil_irq(unsigned int pil) | 869 | |
870 | static void pcic_load_profile_irq(int cpu, unsigned int limit) | ||
840 | { | 871 | { |
841 | writel(get_irqmask(pil), pcic0.pcic_regs+PCI_SYS_INT_TARGET_MASK_CLEAR); | 872 | printk("PCIC: unimplemented code: FILE=%s LINE=%d", __FILE__, __LINE__); |
842 | } | 873 | } |
843 | 874 | ||
844 | void __init sun4m_pci_init_IRQ(void) | 875 | void __init sun4m_pci_init_IRQ(void) |
845 | { | 876 | { |
846 | BTFIXUPSET_CALL(enable_irq, pcic_enable_irq, BTFIXUPCALL_NORM); | 877 | sparc_irq_config.build_device_irq = pcic_build_device_irq; |
847 | BTFIXUPSET_CALL(disable_irq, pcic_disable_irq, BTFIXUPCALL_NORM); | 878 | |
848 | BTFIXUPSET_CALL(enable_pil_irq, pcic_enable_pil_irq, BTFIXUPCALL_NORM); | ||
849 | BTFIXUPSET_CALL(disable_pil_irq, pcic_disable_pil_irq, BTFIXUPCALL_NORM); | ||
850 | BTFIXUPSET_CALL(clear_clock_irq, pcic_clear_clock_irq, BTFIXUPCALL_NORM); | 879 | BTFIXUPSET_CALL(clear_clock_irq, pcic_clear_clock_irq, BTFIXUPCALL_NORM); |
851 | BTFIXUPSET_CALL(load_profile_irq, pcic_load_profile_irq, BTFIXUPCALL_NORM); | 880 | BTFIXUPSET_CALL(load_profile_irq, pcic_load_profile_irq, BTFIXUPCALL_NORM); |
852 | } | 881 | } |
diff --git a/arch/sparc/kernel/perf_event.c b/arch/sparc/kernel/perf_event.c index ee8426ede7c7..2cb0e1c001e2 100644 --- a/arch/sparc/kernel/perf_event.c +++ b/arch/sparc/kernel/perf_event.c | |||
@@ -26,6 +26,7 @@ | |||
26 | #include <asm/nmi.h> | 26 | #include <asm/nmi.h> |
27 | #include <asm/pcr.h> | 27 | #include <asm/pcr.h> |
28 | 28 | ||
29 | #include "kernel.h" | ||
29 | #include "kstack.h" | 30 | #include "kstack.h" |
30 | 31 | ||
31 | /* Sparc64 chips have two performance counters, 32-bits each, with | 32 | /* Sparc64 chips have two performance counters, 32-bits each, with |
diff --git a/arch/sparc/kernel/process_32.c b/arch/sparc/kernel/process_32.c index 17529298c50a..c8cc461ff75f 100644 --- a/arch/sparc/kernel/process_32.c +++ b/arch/sparc/kernel/process_32.c | |||
@@ -128,8 +128,16 @@ void cpu_idle(void) | |||
128 | set_thread_flag(TIF_POLLING_NRFLAG); | 128 | set_thread_flag(TIF_POLLING_NRFLAG); |
129 | /* endless idle loop with no priority at all */ | 129 | /* endless idle loop with no priority at all */ |
130 | while(1) { | 130 | while(1) { |
131 | while (!need_resched()) | 131 | #ifdef CONFIG_SPARC_LEON |
132 | cpu_relax(); | 132 | if (pm_idle) { |
133 | while (!need_resched()) | ||
134 | (*pm_idle)(); | ||
135 | } else | ||
136 | #endif | ||
137 | { | ||
138 | while (!need_resched()) | ||
139 | cpu_relax(); | ||
140 | } | ||
133 | preempt_enable_no_resched(); | 141 | preempt_enable_no_resched(); |
134 | schedule(); | 142 | schedule(); |
135 | preempt_disable(); | 143 | preempt_disable(); |
diff --git a/arch/sparc/kernel/prom_32.c b/arch/sparc/kernel/prom_32.c index 05fb25330583..5ce3d15a99b0 100644 --- a/arch/sparc/kernel/prom_32.c +++ b/arch/sparc/kernel/prom_32.c | |||
@@ -326,7 +326,6 @@ void __init of_console_init(void) | |||
326 | of_console_options = NULL; | 326 | of_console_options = NULL; |
327 | } | 327 | } |
328 | 328 | ||
329 | prom_printf(msg, of_console_path); | ||
330 | printk(msg, of_console_path); | 329 | printk(msg, of_console_path); |
331 | } | 330 | } |
332 | 331 | ||
diff --git a/arch/sparc/kernel/setup_32.c b/arch/sparc/kernel/setup_32.c index 7b8b76c9557f..3609bdee9ed2 100644 --- a/arch/sparc/kernel/setup_32.c +++ b/arch/sparc/kernel/setup_32.c | |||
@@ -103,16 +103,20 @@ static unsigned int boot_flags __initdata = 0; | |||
103 | /* Exported for mm/init.c:paging_init. */ | 103 | /* Exported for mm/init.c:paging_init. */ |
104 | unsigned long cmdline_memory_size __initdata = 0; | 104 | unsigned long cmdline_memory_size __initdata = 0; |
105 | 105 | ||
106 | /* which CPU booted us (0xff = not set) */ | ||
107 | unsigned char boot_cpu_id = 0xff; /* 0xff will make it into DATA section... */ | ||
108 | unsigned char boot_cpu_id4; /* boot_cpu_id << 2 */ | ||
109 | |||
106 | static void | 110 | static void |
107 | prom_console_write(struct console *con, const char *s, unsigned n) | 111 | prom_console_write(struct console *con, const char *s, unsigned n) |
108 | { | 112 | { |
109 | prom_write(s, n); | 113 | prom_write(s, n); |
110 | } | 114 | } |
111 | 115 | ||
112 | static struct console prom_debug_console = { | 116 | static struct console prom_early_console = { |
113 | .name = "debug", | 117 | .name = "earlyprom", |
114 | .write = prom_console_write, | 118 | .write = prom_console_write, |
115 | .flags = CON_PRINTBUFFER, | 119 | .flags = CON_PRINTBUFFER | CON_BOOT, |
116 | .index = -1, | 120 | .index = -1, |
117 | }; | 121 | }; |
118 | 122 | ||
@@ -133,8 +137,7 @@ static void __init process_switch(char c) | |||
133 | prom_halt(); | 137 | prom_halt(); |
134 | break; | 138 | break; |
135 | case 'p': | 139 | case 'p': |
136 | /* Use PROM debug console. */ | 140 | /* Just ignore, this behavior is now the default. */ |
137 | register_console(&prom_debug_console); | ||
138 | break; | 141 | break; |
139 | default: | 142 | default: |
140 | printk("Unknown boot switch (-%c)\n", c); | 143 | printk("Unknown boot switch (-%c)\n", c); |
@@ -215,6 +218,10 @@ void __init setup_arch(char **cmdline_p) | |||
215 | strcpy(boot_command_line, *cmdline_p); | 218 | strcpy(boot_command_line, *cmdline_p); |
216 | parse_early_param(); | 219 | parse_early_param(); |
217 | 220 | ||
221 | boot_flags_init(*cmdline_p); | ||
222 | |||
223 | register_console(&prom_early_console); | ||
224 | |||
218 | /* Set sparc_cpu_model */ | 225 | /* Set sparc_cpu_model */ |
219 | sparc_cpu_model = sun_unknown; | 226 | sparc_cpu_model = sun_unknown; |
220 | if (!strcmp(&cputypval[0], "sun4 ")) | 227 | if (!strcmp(&cputypval[0], "sun4 ")) |
@@ -265,7 +272,6 @@ void __init setup_arch(char **cmdline_p) | |||
265 | #ifdef CONFIG_DUMMY_CONSOLE | 272 | #ifdef CONFIG_DUMMY_CONSOLE |
266 | conswitchp = &dummy_con; | 273 | conswitchp = &dummy_con; |
267 | #endif | 274 | #endif |
268 | boot_flags_init(*cmdline_p); | ||
269 | 275 | ||
270 | idprom_init(); | 276 | idprom_init(); |
271 | if (ARCH_SUN4C) | 277 | if (ARCH_SUN4C) |
@@ -311,75 +317,6 @@ void __init setup_arch(char **cmdline_p) | |||
311 | smp_setup_cpu_possible_map(); | 317 | smp_setup_cpu_possible_map(); |
312 | } | 318 | } |
313 | 319 | ||
314 | static int ncpus_probed; | ||
315 | |||
316 | static int show_cpuinfo(struct seq_file *m, void *__unused) | ||
317 | { | ||
318 | seq_printf(m, | ||
319 | "cpu\t\t: %s\n" | ||
320 | "fpu\t\t: %s\n" | ||
321 | "promlib\t\t: Version %d Revision %d\n" | ||
322 | "prom\t\t: %d.%d\n" | ||
323 | "type\t\t: %s\n" | ||
324 | "ncpus probed\t: %d\n" | ||
325 | "ncpus active\t: %d\n" | ||
326 | #ifndef CONFIG_SMP | ||
327 | "CPU0Bogo\t: %lu.%02lu\n" | ||
328 | "CPU0ClkTck\t: %ld\n" | ||
329 | #endif | ||
330 | , | ||
331 | sparc_cpu_type, | ||
332 | sparc_fpu_type , | ||
333 | romvec->pv_romvers, | ||
334 | prom_rev, | ||
335 | romvec->pv_printrev >> 16, | ||
336 | romvec->pv_printrev & 0xffff, | ||
337 | &cputypval[0], | ||
338 | ncpus_probed, | ||
339 | num_online_cpus() | ||
340 | #ifndef CONFIG_SMP | ||
341 | , cpu_data(0).udelay_val/(500000/HZ), | ||
342 | (cpu_data(0).udelay_val/(5000/HZ)) % 100, | ||
343 | cpu_data(0).clock_tick | ||
344 | #endif | ||
345 | ); | ||
346 | |||
347 | #ifdef CONFIG_SMP | ||
348 | smp_bogo(m); | ||
349 | #endif | ||
350 | mmu_info(m); | ||
351 | #ifdef CONFIG_SMP | ||
352 | smp_info(m); | ||
353 | #endif | ||
354 | return 0; | ||
355 | } | ||
356 | |||
357 | static void *c_start(struct seq_file *m, loff_t *pos) | ||
358 | { | ||
359 | /* The pointer we are returning is arbitrary, | ||
360 | * it just has to be non-NULL and not IS_ERR | ||
361 | * in the success case. | ||
362 | */ | ||
363 | return *pos == 0 ? &c_start : NULL; | ||
364 | } | ||
365 | |||
366 | static void *c_next(struct seq_file *m, void *v, loff_t *pos) | ||
367 | { | ||
368 | ++*pos; | ||
369 | return c_start(m, pos); | ||
370 | } | ||
371 | |||
372 | static void c_stop(struct seq_file *m, void *v) | ||
373 | { | ||
374 | } | ||
375 | |||
376 | const struct seq_operations cpuinfo_op = { | ||
377 | .start =c_start, | ||
378 | .next = c_next, | ||
379 | .stop = c_stop, | ||
380 | .show = show_cpuinfo, | ||
381 | }; | ||
382 | |||
383 | extern int stop_a_enabled; | 320 | extern int stop_a_enabled; |
384 | 321 | ||
385 | void sun_do_break(void) | 322 | void sun_do_break(void) |
diff --git a/arch/sparc/kernel/setup_64.c b/arch/sparc/kernel/setup_64.c index 29bafe051bb1..f3b6850cc8db 100644 --- a/arch/sparc/kernel/setup_64.c +++ b/arch/sparc/kernel/setup_64.c | |||
@@ -339,84 +339,6 @@ void __init setup_arch(char **cmdline_p) | |||
339 | paging_init(); | 339 | paging_init(); |
340 | } | 340 | } |
341 | 341 | ||
342 | /* BUFFER is PAGE_SIZE bytes long. */ | ||
343 | |||
344 | extern void smp_info(struct seq_file *); | ||
345 | extern void smp_bogo(struct seq_file *); | ||
346 | extern void mmu_info(struct seq_file *); | ||
347 | |||
348 | unsigned int dcache_parity_tl1_occurred; | ||
349 | unsigned int icache_parity_tl1_occurred; | ||
350 | |||
351 | int ncpus_probed; | ||
352 | |||
353 | static int show_cpuinfo(struct seq_file *m, void *__unused) | ||
354 | { | ||
355 | seq_printf(m, | ||
356 | "cpu\t\t: %s\n" | ||
357 | "fpu\t\t: %s\n" | ||
358 | "pmu\t\t: %s\n" | ||
359 | "prom\t\t: %s\n" | ||
360 | "type\t\t: %s\n" | ||
361 | "ncpus probed\t: %d\n" | ||
362 | "ncpus active\t: %d\n" | ||
363 | "D$ parity tl1\t: %u\n" | ||
364 | "I$ parity tl1\t: %u\n" | ||
365 | #ifndef CONFIG_SMP | ||
366 | "Cpu0ClkTck\t: %016lx\n" | ||
367 | #endif | ||
368 | , | ||
369 | sparc_cpu_type, | ||
370 | sparc_fpu_type, | ||
371 | sparc_pmu_type, | ||
372 | prom_version, | ||
373 | ((tlb_type == hypervisor) ? | ||
374 | "sun4v" : | ||
375 | "sun4u"), | ||
376 | ncpus_probed, | ||
377 | num_online_cpus(), | ||
378 | dcache_parity_tl1_occurred, | ||
379 | icache_parity_tl1_occurred | ||
380 | #ifndef CONFIG_SMP | ||
381 | , cpu_data(0).clock_tick | ||
382 | #endif | ||
383 | ); | ||
384 | #ifdef CONFIG_SMP | ||
385 | smp_bogo(m); | ||
386 | #endif | ||
387 | mmu_info(m); | ||
388 | #ifdef CONFIG_SMP | ||
389 | smp_info(m); | ||
390 | #endif | ||
391 | return 0; | ||
392 | } | ||
393 | |||
394 | static void *c_start(struct seq_file *m, loff_t *pos) | ||
395 | { | ||
396 | /* The pointer we are returning is arbitrary, | ||
397 | * it just has to be non-NULL and not IS_ERR | ||
398 | * in the success case. | ||
399 | */ | ||
400 | return *pos == 0 ? &c_start : NULL; | ||
401 | } | ||
402 | |||
403 | static void *c_next(struct seq_file *m, void *v, loff_t *pos) | ||
404 | { | ||
405 | ++*pos; | ||
406 | return c_start(m, pos); | ||
407 | } | ||
408 | |||
409 | static void c_stop(struct seq_file *m, void *v) | ||
410 | { | ||
411 | } | ||
412 | |||
413 | const struct seq_operations cpuinfo_op = { | ||
414 | .start =c_start, | ||
415 | .next = c_next, | ||
416 | .stop = c_stop, | ||
417 | .show = show_cpuinfo, | ||
418 | }; | ||
419 | |||
420 | extern int stop_a_enabled; | 342 | extern int stop_a_enabled; |
421 | 343 | ||
422 | void sun_do_break(void) | 344 | void sun_do_break(void) |
diff --git a/arch/sparc/kernel/smp_32.c b/arch/sparc/kernel/smp_32.c index 442286d83435..d5b3958be0b4 100644 --- a/arch/sparc/kernel/smp_32.c +++ b/arch/sparc/kernel/smp_32.c | |||
@@ -37,8 +37,6 @@ | |||
37 | #include "irq.h" | 37 | #include "irq.h" |
38 | 38 | ||
39 | volatile unsigned long cpu_callin_map[NR_CPUS] __cpuinitdata = {0,}; | 39 | volatile unsigned long cpu_callin_map[NR_CPUS] __cpuinitdata = {0,}; |
40 | unsigned char boot_cpu_id = 0; | ||
41 | unsigned char boot_cpu_id4 = 0; /* boot_cpu_id << 2 */ | ||
42 | 40 | ||
43 | cpumask_t smp_commenced_mask = CPU_MASK_NONE; | 41 | cpumask_t smp_commenced_mask = CPU_MASK_NONE; |
44 | 42 | ||
@@ -130,14 +128,57 @@ struct linux_prom_registers smp_penguin_ctable __cpuinitdata = { 0 }; | |||
130 | void smp_send_reschedule(int cpu) | 128 | void smp_send_reschedule(int cpu) |
131 | { | 129 | { |
132 | /* | 130 | /* |
133 | * XXX missing reschedule IPI, see scheduler_ipi() | 131 | * CPU model dependent way of implementing IPI generation targeting |
132 | * a single CPU. The trap handler needs only to do trap entry/return | ||
133 | * to call schedule. | ||
134 | */ | 134 | */ |
135 | BTFIXUP_CALL(smp_ipi_resched)(cpu); | ||
135 | } | 136 | } |
136 | 137 | ||
137 | void smp_send_stop(void) | 138 | void smp_send_stop(void) |
138 | { | 139 | { |
139 | } | 140 | } |
140 | 141 | ||
142 | void arch_send_call_function_single_ipi(int cpu) | ||
143 | { | ||
144 | /* trigger one IPI single call on one CPU */ | ||
145 | BTFIXUP_CALL(smp_ipi_single)(cpu); | ||
146 | } | ||
147 | |||
148 | void arch_send_call_function_ipi_mask(const struct cpumask *mask) | ||
149 | { | ||
150 | int cpu; | ||
151 | |||
152 | /* trigger IPI mask call on each CPU */ | ||
153 | for_each_cpu(cpu, mask) | ||
154 | BTFIXUP_CALL(smp_ipi_mask_one)(cpu); | ||
155 | } | ||
156 | |||
157 | void smp_resched_interrupt(void) | ||
158 | { | ||
159 | irq_enter(); | ||
160 | scheduler_ipi(); | ||
161 | local_cpu_data().irq_resched_count++; | ||
162 | irq_exit(); | ||
163 | /* re-schedule routine called by interrupt return code. */ | ||
164 | } | ||
165 | |||
166 | void smp_call_function_single_interrupt(void) | ||
167 | { | ||
168 | irq_enter(); | ||
169 | generic_smp_call_function_single_interrupt(); | ||
170 | local_cpu_data().irq_call_count++; | ||
171 | irq_exit(); | ||
172 | } | ||
173 | |||
174 | void smp_call_function_interrupt(void) | ||
175 | { | ||
176 | irq_enter(); | ||
177 | generic_smp_call_function_interrupt(); | ||
178 | local_cpu_data().irq_call_count++; | ||
179 | irq_exit(); | ||
180 | } | ||
181 | |||
141 | void smp_flush_cache_all(void) | 182 | void smp_flush_cache_all(void) |
142 | { | 183 | { |
143 | xc0((smpfunc_t) BTFIXUP_CALL(local_flush_cache_all)); | 184 | xc0((smpfunc_t) BTFIXUP_CALL(local_flush_cache_all)); |
@@ -153,9 +194,10 @@ void smp_flush_tlb_all(void) | |||
153 | void smp_flush_cache_mm(struct mm_struct *mm) | 194 | void smp_flush_cache_mm(struct mm_struct *mm) |
154 | { | 195 | { |
155 | if(mm->context != NO_CONTEXT) { | 196 | if(mm->context != NO_CONTEXT) { |
156 | cpumask_t cpu_mask = *mm_cpumask(mm); | 197 | cpumask_t cpu_mask; |
157 | cpu_clear(smp_processor_id(), cpu_mask); | 198 | cpumask_copy(&cpu_mask, mm_cpumask(mm)); |
158 | if (!cpus_empty(cpu_mask)) | 199 | cpumask_clear_cpu(smp_processor_id(), &cpu_mask); |
200 | if (!cpumask_empty(&cpu_mask)) | ||
159 | xc1((smpfunc_t) BTFIXUP_CALL(local_flush_cache_mm), (unsigned long) mm); | 201 | xc1((smpfunc_t) BTFIXUP_CALL(local_flush_cache_mm), (unsigned long) mm); |
160 | local_flush_cache_mm(mm); | 202 | local_flush_cache_mm(mm); |
161 | } | 203 | } |
@@ -164,9 +206,10 @@ void smp_flush_cache_mm(struct mm_struct *mm) | |||
164 | void smp_flush_tlb_mm(struct mm_struct *mm) | 206 | void smp_flush_tlb_mm(struct mm_struct *mm) |
165 | { | 207 | { |
166 | if(mm->context != NO_CONTEXT) { | 208 | if(mm->context != NO_CONTEXT) { |
167 | cpumask_t cpu_mask = *mm_cpumask(mm); | 209 | cpumask_t cpu_mask; |
168 | cpu_clear(smp_processor_id(), cpu_mask); | 210 | cpumask_copy(&cpu_mask, mm_cpumask(mm)); |
169 | if (!cpus_empty(cpu_mask)) { | 211 | cpumask_clear_cpu(smp_processor_id(), &cpu_mask); |
212 | if (!cpumask_empty(&cpu_mask)) { | ||
170 | xc1((smpfunc_t) BTFIXUP_CALL(local_flush_tlb_mm), (unsigned long) mm); | 213 | xc1((smpfunc_t) BTFIXUP_CALL(local_flush_tlb_mm), (unsigned long) mm); |
171 | if(atomic_read(&mm->mm_users) == 1 && current->active_mm == mm) | 214 | if(atomic_read(&mm->mm_users) == 1 && current->active_mm == mm) |
172 | cpumask_copy(mm_cpumask(mm), | 215 | cpumask_copy(mm_cpumask(mm), |
@@ -182,9 +225,10 @@ void smp_flush_cache_range(struct vm_area_struct *vma, unsigned long start, | |||
182 | struct mm_struct *mm = vma->vm_mm; | 225 | struct mm_struct *mm = vma->vm_mm; |
183 | 226 | ||
184 | if (mm->context != NO_CONTEXT) { | 227 | if (mm->context != NO_CONTEXT) { |
185 | cpumask_t cpu_mask = *mm_cpumask(mm); | 228 | cpumask_t cpu_mask; |
186 | cpu_clear(smp_processor_id(), cpu_mask); | 229 | cpumask_copy(&cpu_mask, mm_cpumask(mm)); |
187 | if (!cpus_empty(cpu_mask)) | 230 | cpumask_clear_cpu(smp_processor_id(), &cpu_mask); |
231 | if (!cpumask_empty(&cpu_mask)) | ||
188 | xc3((smpfunc_t) BTFIXUP_CALL(local_flush_cache_range), (unsigned long) vma, start, end); | 232 | xc3((smpfunc_t) BTFIXUP_CALL(local_flush_cache_range), (unsigned long) vma, start, end); |
189 | local_flush_cache_range(vma, start, end); | 233 | local_flush_cache_range(vma, start, end); |
190 | } | 234 | } |
@@ -196,9 +240,10 @@ void smp_flush_tlb_range(struct vm_area_struct *vma, unsigned long start, | |||
196 | struct mm_struct *mm = vma->vm_mm; | 240 | struct mm_struct *mm = vma->vm_mm; |
197 | 241 | ||
198 | if (mm->context != NO_CONTEXT) { | 242 | if (mm->context != NO_CONTEXT) { |
199 | cpumask_t cpu_mask = *mm_cpumask(mm); | 243 | cpumask_t cpu_mask; |
200 | cpu_clear(smp_processor_id(), cpu_mask); | 244 | cpumask_copy(&cpu_mask, mm_cpumask(mm)); |
201 | if (!cpus_empty(cpu_mask)) | 245 | cpumask_clear_cpu(smp_processor_id(), &cpu_mask); |
246 | if (!cpumask_empty(&cpu_mask)) | ||
202 | xc3((smpfunc_t) BTFIXUP_CALL(local_flush_tlb_range), (unsigned long) vma, start, end); | 247 | xc3((smpfunc_t) BTFIXUP_CALL(local_flush_tlb_range), (unsigned long) vma, start, end); |
203 | local_flush_tlb_range(vma, start, end); | 248 | local_flush_tlb_range(vma, start, end); |
204 | } | 249 | } |
@@ -209,9 +254,10 @@ void smp_flush_cache_page(struct vm_area_struct *vma, unsigned long page) | |||
209 | struct mm_struct *mm = vma->vm_mm; | 254 | struct mm_struct *mm = vma->vm_mm; |
210 | 255 | ||
211 | if(mm->context != NO_CONTEXT) { | 256 | if(mm->context != NO_CONTEXT) { |
212 | cpumask_t cpu_mask = *mm_cpumask(mm); | 257 | cpumask_t cpu_mask; |
213 | cpu_clear(smp_processor_id(), cpu_mask); | 258 | cpumask_copy(&cpu_mask, mm_cpumask(mm)); |
214 | if (!cpus_empty(cpu_mask)) | 259 | cpumask_clear_cpu(smp_processor_id(), &cpu_mask); |
260 | if (!cpumask_empty(&cpu_mask)) | ||
215 | xc2((smpfunc_t) BTFIXUP_CALL(local_flush_cache_page), (unsigned long) vma, page); | 261 | xc2((smpfunc_t) BTFIXUP_CALL(local_flush_cache_page), (unsigned long) vma, page); |
216 | local_flush_cache_page(vma, page); | 262 | local_flush_cache_page(vma, page); |
217 | } | 263 | } |
@@ -222,19 +268,15 @@ void smp_flush_tlb_page(struct vm_area_struct *vma, unsigned long page) | |||
222 | struct mm_struct *mm = vma->vm_mm; | 268 | struct mm_struct *mm = vma->vm_mm; |
223 | 269 | ||
224 | if(mm->context != NO_CONTEXT) { | 270 | if(mm->context != NO_CONTEXT) { |
225 | cpumask_t cpu_mask = *mm_cpumask(mm); | 271 | cpumask_t cpu_mask; |
226 | cpu_clear(smp_processor_id(), cpu_mask); | 272 | cpumask_copy(&cpu_mask, mm_cpumask(mm)); |
227 | if (!cpus_empty(cpu_mask)) | 273 | cpumask_clear_cpu(smp_processor_id(), &cpu_mask); |
274 | if (!cpumask_empty(&cpu_mask)) | ||
228 | xc2((smpfunc_t) BTFIXUP_CALL(local_flush_tlb_page), (unsigned long) vma, page); | 275 | xc2((smpfunc_t) BTFIXUP_CALL(local_flush_tlb_page), (unsigned long) vma, page); |
229 | local_flush_tlb_page(vma, page); | 276 | local_flush_tlb_page(vma, page); |
230 | } | 277 | } |
231 | } | 278 | } |
232 | 279 | ||
233 | void smp_reschedule_irq(void) | ||
234 | { | ||
235 | set_need_resched(); | ||
236 | } | ||
237 | |||
238 | void smp_flush_page_to_ram(unsigned long page) | 280 | void smp_flush_page_to_ram(unsigned long page) |
239 | { | 281 | { |
240 | /* Current theory is that those who call this are the one's | 282 | /* Current theory is that those who call this are the one's |
@@ -251,9 +293,10 @@ void smp_flush_page_to_ram(unsigned long page) | |||
251 | 293 | ||
252 | void smp_flush_sig_insns(struct mm_struct *mm, unsigned long insn_addr) | 294 | void smp_flush_sig_insns(struct mm_struct *mm, unsigned long insn_addr) |
253 | { | 295 | { |
254 | cpumask_t cpu_mask = *mm_cpumask(mm); | 296 | cpumask_t cpu_mask; |
255 | cpu_clear(smp_processor_id(), cpu_mask); | 297 | cpumask_copy(&cpu_mask, mm_cpumask(mm)); |
256 | if (!cpus_empty(cpu_mask)) | 298 | cpumask_clear_cpu(smp_processor_id(), &cpu_mask); |
299 | if (!cpumask_empty(&cpu_mask)) | ||
257 | xc2((smpfunc_t) BTFIXUP_CALL(local_flush_sig_insns), (unsigned long) mm, insn_addr); | 300 | xc2((smpfunc_t) BTFIXUP_CALL(local_flush_sig_insns), (unsigned long) mm, insn_addr); |
258 | local_flush_sig_insns(mm, insn_addr); | 301 | local_flush_sig_insns(mm, insn_addr); |
259 | } | 302 | } |
@@ -407,7 +450,7 @@ int __cpuinit __cpu_up(unsigned int cpu) | |||
407 | }; | 450 | }; |
408 | 451 | ||
409 | if (!ret) { | 452 | if (!ret) { |
410 | cpu_set(cpu, smp_commenced_mask); | 453 | cpumask_set_cpu(cpu, &smp_commenced_mask); |
411 | while (!cpu_online(cpu)) | 454 | while (!cpu_online(cpu)) |
412 | mb(); | 455 | mb(); |
413 | } | 456 | } |
diff --git a/arch/sparc/kernel/smp_64.c b/arch/sparc/kernel/smp_64.c index 9478da7fdb3e..99cb17251bb5 100644 --- a/arch/sparc/kernel/smp_64.c +++ b/arch/sparc/kernel/smp_64.c | |||
@@ -121,11 +121,11 @@ void __cpuinit smp_callin(void) | |||
121 | /* inform the notifiers about the new cpu */ | 121 | /* inform the notifiers about the new cpu */ |
122 | notify_cpu_starting(cpuid); | 122 | notify_cpu_starting(cpuid); |
123 | 123 | ||
124 | while (!cpu_isset(cpuid, smp_commenced_mask)) | 124 | while (!cpumask_test_cpu(cpuid, &smp_commenced_mask)) |
125 | rmb(); | 125 | rmb(); |
126 | 126 | ||
127 | ipi_call_lock_irq(); | 127 | ipi_call_lock_irq(); |
128 | cpu_set(cpuid, cpu_online_map); | 128 | set_cpu_online(cpuid, true); |
129 | ipi_call_unlock_irq(); | 129 | ipi_call_unlock_irq(); |
130 | 130 | ||
131 | /* idle thread is expected to have preempt disabled */ | 131 | /* idle thread is expected to have preempt disabled */ |
@@ -785,7 +785,7 @@ static void xcall_deliver(u64 data0, u64 data1, u64 data2, const cpumask_t *mask | |||
785 | 785 | ||
786 | /* Send cross call to all processors mentioned in MASK_P | 786 | /* Send cross call to all processors mentioned in MASK_P |
787 | * except self. Really, there are only two cases currently, | 787 | * except self. Really, there are only two cases currently, |
788 | * "&cpu_online_map" and "&mm->cpu_vm_mask". | 788 | * "cpu_online_mask" and "mm_cpumask(mm)". |
789 | */ | 789 | */ |
790 | static void smp_cross_call_masked(unsigned long *func, u32 ctx, u64 data1, u64 data2, const cpumask_t *mask) | 790 | static void smp_cross_call_masked(unsigned long *func, u32 ctx, u64 data1, u64 data2, const cpumask_t *mask) |
791 | { | 791 | { |
@@ -797,7 +797,7 @@ static void smp_cross_call_masked(unsigned long *func, u32 ctx, u64 data1, u64 d | |||
797 | /* Send cross call to all processors except self. */ | 797 | /* Send cross call to all processors except self. */ |
798 | static void smp_cross_call(unsigned long *func, u32 ctx, u64 data1, u64 data2) | 798 | static void smp_cross_call(unsigned long *func, u32 ctx, u64 data1, u64 data2) |
799 | { | 799 | { |
800 | smp_cross_call_masked(func, ctx, data1, data2, &cpu_online_map); | 800 | smp_cross_call_masked(func, ctx, data1, data2, cpu_online_mask); |
801 | } | 801 | } |
802 | 802 | ||
803 | extern unsigned long xcall_sync_tick; | 803 | extern unsigned long xcall_sync_tick; |
@@ -805,7 +805,7 @@ extern unsigned long xcall_sync_tick; | |||
805 | static void smp_start_sync_tick_client(int cpu) | 805 | static void smp_start_sync_tick_client(int cpu) |
806 | { | 806 | { |
807 | xcall_deliver((u64) &xcall_sync_tick, 0, 0, | 807 | xcall_deliver((u64) &xcall_sync_tick, 0, 0, |
808 | &cpumask_of_cpu(cpu)); | 808 | cpumask_of(cpu)); |
809 | } | 809 | } |
810 | 810 | ||
811 | extern unsigned long xcall_call_function; | 811 | extern unsigned long xcall_call_function; |
@@ -820,7 +820,7 @@ extern unsigned long xcall_call_function_single; | |||
820 | void arch_send_call_function_single_ipi(int cpu) | 820 | void arch_send_call_function_single_ipi(int cpu) |
821 | { | 821 | { |
822 | xcall_deliver((u64) &xcall_call_function_single, 0, 0, | 822 | xcall_deliver((u64) &xcall_call_function_single, 0, 0, |
823 | &cpumask_of_cpu(cpu)); | 823 | cpumask_of(cpu)); |
824 | } | 824 | } |
825 | 825 | ||
826 | void __irq_entry smp_call_function_client(int irq, struct pt_regs *regs) | 826 | void __irq_entry smp_call_function_client(int irq, struct pt_regs *regs) |
@@ -918,7 +918,7 @@ void smp_flush_dcache_page_impl(struct page *page, int cpu) | |||
918 | } | 918 | } |
919 | if (data0) { | 919 | if (data0) { |
920 | xcall_deliver(data0, __pa(pg_addr), | 920 | xcall_deliver(data0, __pa(pg_addr), |
921 | (u64) pg_addr, &cpumask_of_cpu(cpu)); | 921 | (u64) pg_addr, cpumask_of(cpu)); |
922 | #ifdef CONFIG_DEBUG_DCFLUSH | 922 | #ifdef CONFIG_DEBUG_DCFLUSH |
923 | atomic_inc(&dcpage_flushes_xcall); | 923 | atomic_inc(&dcpage_flushes_xcall); |
924 | #endif | 924 | #endif |
@@ -954,7 +954,7 @@ void flush_dcache_page_all(struct mm_struct *mm, struct page *page) | |||
954 | } | 954 | } |
955 | if (data0) { | 955 | if (data0) { |
956 | xcall_deliver(data0, __pa(pg_addr), | 956 | xcall_deliver(data0, __pa(pg_addr), |
957 | (u64) pg_addr, &cpu_online_map); | 957 | (u64) pg_addr, cpu_online_mask); |
958 | #ifdef CONFIG_DEBUG_DCFLUSH | 958 | #ifdef CONFIG_DEBUG_DCFLUSH |
959 | atomic_inc(&dcpage_flushes_xcall); | 959 | atomic_inc(&dcpage_flushes_xcall); |
960 | #endif | 960 | #endif |
@@ -1197,32 +1197,32 @@ void __devinit smp_fill_in_sib_core_maps(void) | |||
1197 | for_each_present_cpu(i) { | 1197 | for_each_present_cpu(i) { |
1198 | unsigned int j; | 1198 | unsigned int j; |
1199 | 1199 | ||
1200 | cpus_clear(cpu_core_map[i]); | 1200 | cpumask_clear(&cpu_core_map[i]); |
1201 | if (cpu_data(i).core_id == 0) { | 1201 | if (cpu_data(i).core_id == 0) { |
1202 | cpu_set(i, cpu_core_map[i]); | 1202 | cpumask_set_cpu(i, &cpu_core_map[i]); |
1203 | continue; | 1203 | continue; |
1204 | } | 1204 | } |
1205 | 1205 | ||
1206 | for_each_present_cpu(j) { | 1206 | for_each_present_cpu(j) { |
1207 | if (cpu_data(i).core_id == | 1207 | if (cpu_data(i).core_id == |
1208 | cpu_data(j).core_id) | 1208 | cpu_data(j).core_id) |
1209 | cpu_set(j, cpu_core_map[i]); | 1209 | cpumask_set_cpu(j, &cpu_core_map[i]); |
1210 | } | 1210 | } |
1211 | } | 1211 | } |
1212 | 1212 | ||
1213 | for_each_present_cpu(i) { | 1213 | for_each_present_cpu(i) { |
1214 | unsigned int j; | 1214 | unsigned int j; |
1215 | 1215 | ||
1216 | cpus_clear(per_cpu(cpu_sibling_map, i)); | 1216 | cpumask_clear(&per_cpu(cpu_sibling_map, i)); |
1217 | if (cpu_data(i).proc_id == -1) { | 1217 | if (cpu_data(i).proc_id == -1) { |
1218 | cpu_set(i, per_cpu(cpu_sibling_map, i)); | 1218 | cpumask_set_cpu(i, &per_cpu(cpu_sibling_map, i)); |
1219 | continue; | 1219 | continue; |
1220 | } | 1220 | } |
1221 | 1221 | ||
1222 | for_each_present_cpu(j) { | 1222 | for_each_present_cpu(j) { |
1223 | if (cpu_data(i).proc_id == | 1223 | if (cpu_data(i).proc_id == |
1224 | cpu_data(j).proc_id) | 1224 | cpu_data(j).proc_id) |
1225 | cpu_set(j, per_cpu(cpu_sibling_map, i)); | 1225 | cpumask_set_cpu(j, &per_cpu(cpu_sibling_map, i)); |
1226 | } | 1226 | } |
1227 | } | 1227 | } |
1228 | } | 1228 | } |
@@ -1232,10 +1232,10 @@ int __cpuinit __cpu_up(unsigned int cpu) | |||
1232 | int ret = smp_boot_one_cpu(cpu); | 1232 | int ret = smp_boot_one_cpu(cpu); |
1233 | 1233 | ||
1234 | if (!ret) { | 1234 | if (!ret) { |
1235 | cpu_set(cpu, smp_commenced_mask); | 1235 | cpumask_set_cpu(cpu, &smp_commenced_mask); |
1236 | while (!cpu_isset(cpu, cpu_online_map)) | 1236 | while (!cpu_online(cpu)) |
1237 | mb(); | 1237 | mb(); |
1238 | if (!cpu_isset(cpu, cpu_online_map)) { | 1238 | if (!cpu_online(cpu)) { |
1239 | ret = -ENODEV; | 1239 | ret = -ENODEV; |
1240 | } else { | 1240 | } else { |
1241 | /* On SUN4V, writes to %tick and %stick are | 1241 | /* On SUN4V, writes to %tick and %stick are |
@@ -1269,7 +1269,7 @@ void cpu_play_dead(void) | |||
1269 | tb->nonresum_mondo_pa, 0); | 1269 | tb->nonresum_mondo_pa, 0); |
1270 | } | 1270 | } |
1271 | 1271 | ||
1272 | cpu_clear(cpu, smp_commenced_mask); | 1272 | cpumask_clear_cpu(cpu, &smp_commenced_mask); |
1273 | membar_safe("#Sync"); | 1273 | membar_safe("#Sync"); |
1274 | 1274 | ||
1275 | local_irq_disable(); | 1275 | local_irq_disable(); |
@@ -1290,13 +1290,13 @@ int __cpu_disable(void) | |||
1290 | cpuinfo_sparc *c; | 1290 | cpuinfo_sparc *c; |
1291 | int i; | 1291 | int i; |
1292 | 1292 | ||
1293 | for_each_cpu_mask(i, cpu_core_map[cpu]) | 1293 | for_each_cpu(i, &cpu_core_map[cpu]) |
1294 | cpu_clear(cpu, cpu_core_map[i]); | 1294 | cpumask_clear_cpu(cpu, &cpu_core_map[i]); |
1295 | cpus_clear(cpu_core_map[cpu]); | 1295 | cpumask_clear(&cpu_core_map[cpu]); |
1296 | 1296 | ||
1297 | for_each_cpu_mask(i, per_cpu(cpu_sibling_map, cpu)) | 1297 | for_each_cpu(i, &per_cpu(cpu_sibling_map, cpu)) |
1298 | cpu_clear(cpu, per_cpu(cpu_sibling_map, i)); | 1298 | cpumask_clear_cpu(cpu, &per_cpu(cpu_sibling_map, i)); |
1299 | cpus_clear(per_cpu(cpu_sibling_map, cpu)); | 1299 | cpumask_clear(&per_cpu(cpu_sibling_map, cpu)); |
1300 | 1300 | ||
1301 | c = &cpu_data(cpu); | 1301 | c = &cpu_data(cpu); |
1302 | 1302 | ||
@@ -1313,7 +1313,7 @@ int __cpu_disable(void) | |||
1313 | local_irq_disable(); | 1313 | local_irq_disable(); |
1314 | 1314 | ||
1315 | ipi_call_lock(); | 1315 | ipi_call_lock(); |
1316 | cpu_clear(cpu, cpu_online_map); | 1316 | set_cpu_online(cpu, false); |
1317 | ipi_call_unlock(); | 1317 | ipi_call_unlock(); |
1318 | 1318 | ||
1319 | cpu_map_rebuild(); | 1319 | cpu_map_rebuild(); |
@@ -1327,11 +1327,11 @@ void __cpu_die(unsigned int cpu) | |||
1327 | 1327 | ||
1328 | for (i = 0; i < 100; i++) { | 1328 | for (i = 0; i < 100; i++) { |
1329 | smp_rmb(); | 1329 | smp_rmb(); |
1330 | if (!cpu_isset(cpu, smp_commenced_mask)) | 1330 | if (!cpumask_test_cpu(cpu, &smp_commenced_mask)) |
1331 | break; | 1331 | break; |
1332 | msleep(100); | 1332 | msleep(100); |
1333 | } | 1333 | } |
1334 | if (cpu_isset(cpu, smp_commenced_mask)) { | 1334 | if (cpumask_test_cpu(cpu, &smp_commenced_mask)) { |
1335 | printk(KERN_ERR "CPU %u didn't die...\n", cpu); | 1335 | printk(KERN_ERR "CPU %u didn't die...\n", cpu); |
1336 | } else { | 1336 | } else { |
1337 | #if defined(CONFIG_SUN_LDOMS) | 1337 | #if defined(CONFIG_SUN_LDOMS) |
@@ -1341,7 +1341,7 @@ void __cpu_die(unsigned int cpu) | |||
1341 | do { | 1341 | do { |
1342 | hv_err = sun4v_cpu_stop(cpu); | 1342 | hv_err = sun4v_cpu_stop(cpu); |
1343 | if (hv_err == HV_EOK) { | 1343 | if (hv_err == HV_EOK) { |
1344 | cpu_clear(cpu, cpu_present_map); | 1344 | set_cpu_present(cpu, false); |
1345 | break; | 1345 | break; |
1346 | } | 1346 | } |
1347 | } while (--limit > 0); | 1347 | } while (--limit > 0); |
@@ -1362,7 +1362,7 @@ void __init smp_cpus_done(unsigned int max_cpus) | |||
1362 | void smp_send_reschedule(int cpu) | 1362 | void smp_send_reschedule(int cpu) |
1363 | { | 1363 | { |
1364 | xcall_deliver((u64) &xcall_receive_signal, 0, 0, | 1364 | xcall_deliver((u64) &xcall_receive_signal, 0, 0, |
1365 | &cpumask_of_cpu(cpu)); | 1365 | cpumask_of(cpu)); |
1366 | } | 1366 | } |
1367 | 1367 | ||
1368 | void __irq_entry smp_receive_signal_client(int irq, struct pt_regs *regs) | 1368 | void __irq_entry smp_receive_signal_client(int irq, struct pt_regs *regs) |
diff --git a/arch/sparc/kernel/sun4c_irq.c b/arch/sparc/kernel/sun4c_irq.c index 90eea38ad66f..f6bf25a2ff80 100644 --- a/arch/sparc/kernel/sun4c_irq.c +++ b/arch/sparc/kernel/sun4c_irq.c | |||
@@ -65,62 +65,94 @@ | |||
65 | */ | 65 | */ |
66 | unsigned char __iomem *interrupt_enable; | 66 | unsigned char __iomem *interrupt_enable; |
67 | 67 | ||
68 | static void sun4c_disable_irq(unsigned int irq_nr) | 68 | static void sun4c_mask_irq(struct irq_data *data) |
69 | { | 69 | { |
70 | unsigned long flags; | 70 | unsigned long mask = (unsigned long)data->chip_data; |
71 | unsigned char current_mask, new_mask; | 71 | |
72 | 72 | if (mask) { | |
73 | local_irq_save(flags); | 73 | unsigned long flags; |
74 | irq_nr &= (NR_IRQS - 1); | 74 | |
75 | current_mask = sbus_readb(interrupt_enable); | 75 | local_irq_save(flags); |
76 | switch (irq_nr) { | 76 | mask = sbus_readb(interrupt_enable) & ~mask; |
77 | case 1: | 77 | sbus_writeb(mask, interrupt_enable); |
78 | new_mask = ((current_mask) & (~(SUN4C_INT_E1))); | ||
79 | break; | ||
80 | case 8: | ||
81 | new_mask = ((current_mask) & (~(SUN4C_INT_E8))); | ||
82 | break; | ||
83 | case 10: | ||
84 | new_mask = ((current_mask) & (~(SUN4C_INT_E10))); | ||
85 | break; | ||
86 | case 14: | ||
87 | new_mask = ((current_mask) & (~(SUN4C_INT_E14))); | ||
88 | break; | ||
89 | default: | ||
90 | local_irq_restore(flags); | 78 | local_irq_restore(flags); |
91 | return; | ||
92 | } | 79 | } |
93 | sbus_writeb(new_mask, interrupt_enable); | ||
94 | local_irq_restore(flags); | ||
95 | } | 80 | } |
96 | 81 | ||
97 | static void sun4c_enable_irq(unsigned int irq_nr) | 82 | static void sun4c_unmask_irq(struct irq_data *data) |
98 | { | 83 | { |
99 | unsigned long flags; | 84 | unsigned long mask = (unsigned long)data->chip_data; |
100 | unsigned char current_mask, new_mask; | 85 | |
101 | 86 | if (mask) { | |
102 | local_irq_save(flags); | 87 | unsigned long flags; |
103 | irq_nr &= (NR_IRQS - 1); | 88 | |
104 | current_mask = sbus_readb(interrupt_enable); | 89 | local_irq_save(flags); |
105 | switch (irq_nr) { | 90 | mask = sbus_readb(interrupt_enable) | mask; |
106 | case 1: | 91 | sbus_writeb(mask, interrupt_enable); |
107 | new_mask = ((current_mask) | SUN4C_INT_E1); | ||
108 | break; | ||
109 | case 8: | ||
110 | new_mask = ((current_mask) | SUN4C_INT_E8); | ||
111 | break; | ||
112 | case 10: | ||
113 | new_mask = ((current_mask) | SUN4C_INT_E10); | ||
114 | break; | ||
115 | case 14: | ||
116 | new_mask = ((current_mask) | SUN4C_INT_E14); | ||
117 | break; | ||
118 | default: | ||
119 | local_irq_restore(flags); | 92 | local_irq_restore(flags); |
120 | return; | ||
121 | } | 93 | } |
122 | sbus_writeb(new_mask, interrupt_enable); | 94 | } |
123 | local_irq_restore(flags); | 95 | |
96 | static unsigned int sun4c_startup_irq(struct irq_data *data) | ||
97 | { | ||
98 | irq_link(data->irq); | ||
99 | sun4c_unmask_irq(data); | ||
100 | |||
101 | return 0; | ||
102 | } | ||
103 | |||
104 | static void sun4c_shutdown_irq(struct irq_data *data) | ||
105 | { | ||
106 | sun4c_mask_irq(data); | ||
107 | irq_unlink(data->irq); | ||
108 | } | ||
109 | |||
110 | static struct irq_chip sun4c_irq = { | ||
111 | .name = "sun4c", | ||
112 | .irq_startup = sun4c_startup_irq, | ||
113 | .irq_shutdown = sun4c_shutdown_irq, | ||
114 | .irq_mask = sun4c_mask_irq, | ||
115 | .irq_unmask = sun4c_unmask_irq, | ||
116 | }; | ||
117 | |||
118 | static unsigned int sun4c_build_device_irq(struct platform_device *op, | ||
119 | unsigned int real_irq) | ||
120 | { | ||
121 | unsigned int irq; | ||
122 | |||
123 | if (real_irq >= 16) { | ||
124 | prom_printf("Bogus sun4c IRQ %u\n", real_irq); | ||
125 | prom_halt(); | ||
126 | } | ||
127 | |||
128 | irq = irq_alloc(real_irq, real_irq); | ||
129 | if (irq) { | ||
130 | unsigned long mask = 0UL; | ||
131 | |||
132 | switch (real_irq) { | ||
133 | case 1: | ||
134 | mask = SUN4C_INT_E1; | ||
135 | break; | ||
136 | case 8: | ||
137 | mask = SUN4C_INT_E8; | ||
138 | break; | ||
139 | case 10: | ||
140 | mask = SUN4C_INT_E10; | ||
141 | break; | ||
142 | case 14: | ||
143 | mask = SUN4C_INT_E14; | ||
144 | break; | ||
145 | default: | ||
146 | /* All the rest are either always enabled, | ||
147 | * or are for signalling software interrupts. | ||
148 | */ | ||
149 | break; | ||
150 | } | ||
151 | irq_set_chip_and_handler_name(irq, &sun4c_irq, | ||
152 | handle_level_irq, "level"); | ||
153 | irq_set_chip_data(irq, (void *)mask); | ||
154 | } | ||
155 | return irq; | ||
124 | } | 156 | } |
125 | 157 | ||
126 | struct sun4c_timer_info { | 158 | struct sun4c_timer_info { |
@@ -144,8 +176,9 @@ static void sun4c_load_profile_irq(int cpu, unsigned int limit) | |||
144 | 176 | ||
145 | static void __init sun4c_init_timers(irq_handler_t counter_fn) | 177 | static void __init sun4c_init_timers(irq_handler_t counter_fn) |
146 | { | 178 | { |
147 | const struct linux_prom_irqs *irq; | 179 | const struct linux_prom_irqs *prom_irqs; |
148 | struct device_node *dp; | 180 | struct device_node *dp; |
181 | unsigned int irq; | ||
149 | const u32 *addr; | 182 | const u32 *addr; |
150 | int err; | 183 | int err; |
151 | 184 | ||
@@ -163,9 +196,9 @@ static void __init sun4c_init_timers(irq_handler_t counter_fn) | |||
163 | 196 | ||
164 | sun4c_timers = (void __iomem *) (unsigned long) addr[0]; | 197 | sun4c_timers = (void __iomem *) (unsigned long) addr[0]; |
165 | 198 | ||
166 | irq = of_get_property(dp, "intr", NULL); | 199 | prom_irqs = of_get_property(dp, "intr", NULL); |
167 | of_node_put(dp); | 200 | of_node_put(dp); |
168 | if (!irq) { | 201 | if (!prom_irqs) { |
169 | prom_printf("sun4c_init_timers: No intr property\n"); | 202 | prom_printf("sun4c_init_timers: No intr property\n"); |
170 | prom_halt(); | 203 | prom_halt(); |
171 | } | 204 | } |
@@ -178,15 +211,15 @@ static void __init sun4c_init_timers(irq_handler_t counter_fn) | |||
178 | 211 | ||
179 | master_l10_counter = &sun4c_timers->l10_count; | 212 | master_l10_counter = &sun4c_timers->l10_count; |
180 | 213 | ||
181 | err = request_irq(irq[0].pri, counter_fn, | 214 | irq = sun4c_build_device_irq(NULL, prom_irqs[0].pri); |
182 | (IRQF_DISABLED | SA_STATIC_ALLOC), | 215 | err = request_irq(irq, counter_fn, IRQF_TIMER, "timer", NULL); |
183 | "timer", NULL); | ||
184 | if (err) { | 216 | if (err) { |
185 | prom_printf("sun4c_init_timers: request_irq() fails with %d\n", err); | 217 | prom_printf("sun4c_init_timers: request_irq() fails with %d\n", err); |
186 | prom_halt(); | 218 | prom_halt(); |
187 | } | 219 | } |
188 | 220 | ||
189 | sun4c_disable_irq(irq[1].pri); | 221 | /* disable timer interrupt */ |
222 | sun4c_mask_irq(irq_get_irq_data(irq)); | ||
190 | } | 223 | } |
191 | 224 | ||
192 | #ifdef CONFIG_SMP | 225 | #ifdef CONFIG_SMP |
@@ -215,14 +248,11 @@ void __init sun4c_init_IRQ(void) | |||
215 | 248 | ||
216 | interrupt_enable = (void __iomem *) (unsigned long) addr[0]; | 249 | interrupt_enable = (void __iomem *) (unsigned long) addr[0]; |
217 | 250 | ||
218 | BTFIXUPSET_CALL(enable_irq, sun4c_enable_irq, BTFIXUPCALL_NORM); | ||
219 | BTFIXUPSET_CALL(disable_irq, sun4c_disable_irq, BTFIXUPCALL_NORM); | ||
220 | BTFIXUPSET_CALL(enable_pil_irq, sun4c_enable_irq, BTFIXUPCALL_NORM); | ||
221 | BTFIXUPSET_CALL(disable_pil_irq, sun4c_disable_irq, BTFIXUPCALL_NORM); | ||
222 | BTFIXUPSET_CALL(clear_clock_irq, sun4c_clear_clock_irq, BTFIXUPCALL_NORM); | 251 | BTFIXUPSET_CALL(clear_clock_irq, sun4c_clear_clock_irq, BTFIXUPCALL_NORM); |
223 | BTFIXUPSET_CALL(load_profile_irq, sun4c_load_profile_irq, BTFIXUPCALL_NOP); | 252 | BTFIXUPSET_CALL(load_profile_irq, sun4c_load_profile_irq, BTFIXUPCALL_NOP); |
224 | 253 | ||
225 | sparc_irq_config.init_timers = sun4c_init_timers; | 254 | sparc_irq_config.init_timers = sun4c_init_timers; |
255 | sparc_irq_config.build_device_irq = sun4c_build_device_irq; | ||
226 | 256 | ||
227 | #ifdef CONFIG_SMP | 257 | #ifdef CONFIG_SMP |
228 | BTFIXUPSET_CALL(set_cpu_int, sun4c_nop, BTFIXUPCALL_NOP); | 258 | BTFIXUPSET_CALL(set_cpu_int, sun4c_nop, BTFIXUPCALL_NOP); |
diff --git a/arch/sparc/kernel/sun4d_irq.c b/arch/sparc/kernel/sun4d_irq.c index 77b4a8992710..a9ea60eb2c10 100644 --- a/arch/sparc/kernel/sun4d_irq.c +++ b/arch/sparc/kernel/sun4d_irq.c | |||
@@ -14,6 +14,7 @@ | |||
14 | #include <asm/io.h> | 14 | #include <asm/io.h> |
15 | #include <asm/sbi.h> | 15 | #include <asm/sbi.h> |
16 | #include <asm/cacheflush.h> | 16 | #include <asm/cacheflush.h> |
17 | #include <asm/setup.h> | ||
17 | 18 | ||
18 | #include "kernel.h" | 19 | #include "kernel.h" |
19 | #include "irq.h" | 20 | #include "irq.h" |
@@ -22,22 +23,20 @@ | |||
22 | * cpu local. CPU local interrupts cover the timer interrupts | 23 | * cpu local. CPU local interrupts cover the timer interrupts |
23 | * and whatnot, and we encode those as normal PILs between | 24 | * and whatnot, and we encode those as normal PILs between |
24 | * 0 and 15. | 25 | * 0 and 15. |
25 | * | 26 | * SBUS interrupts are encodes as a combination of board, level and slot. |
26 | * SBUS interrupts are encoded integers including the board number | ||
27 | * (plus one), the SBUS level, and the SBUS slot number. Sun4D | ||
28 | * IRQ dispatch is done by: | ||
29 | * | ||
30 | * 1) Reading the BW local interrupt table in order to get the bus | ||
31 | * interrupt mask. | ||
32 | * | ||
33 | * This table is indexed by SBUS interrupt level which can be | ||
34 | * derived from the PIL we got interrupted on. | ||
35 | * | ||
36 | * 2) For each bus showing interrupt pending from #1, read the | ||
37 | * SBI interrupt state register. This will indicate which slots | ||
38 | * have interrupts pending for that SBUS interrupt level. | ||
39 | */ | 27 | */ |
40 | 28 | ||
29 | struct sun4d_handler_data { | ||
30 | unsigned int cpuid; /* target cpu */ | ||
31 | unsigned int real_irq; /* interrupt level */ | ||
32 | }; | ||
33 | |||
34 | |||
35 | static unsigned int sun4d_encode_irq(int board, int lvl, int slot) | ||
36 | { | ||
37 | return (board + 1) << 5 | (lvl << 2) | slot; | ||
38 | } | ||
39 | |||
41 | struct sun4d_timer_regs { | 40 | struct sun4d_timer_regs { |
42 | u32 l10_timer_limit; | 41 | u32 l10_timer_limit; |
43 | u32 l10_cur_countx; | 42 | u32 l10_cur_countx; |
@@ -48,17 +47,12 @@ struct sun4d_timer_regs { | |||
48 | 47 | ||
49 | static struct sun4d_timer_regs __iomem *sun4d_timers; | 48 | static struct sun4d_timer_regs __iomem *sun4d_timers; |
50 | 49 | ||
51 | #define TIMER_IRQ 10 | 50 | #define SUN4D_TIMER_IRQ 10 |
52 | |||
53 | #define MAX_STATIC_ALLOC 4 | ||
54 | static unsigned char sbus_tid[32]; | ||
55 | |||
56 | static struct irqaction *irq_action[NR_IRQS]; | ||
57 | 51 | ||
58 | static struct sbus_action { | 52 | /* Specify which cpu handle interrupts from which board. |
59 | struct irqaction *action; | 53 | * Index is board - value is cpu. |
60 | /* For SMP this needs to be extended */ | 54 | */ |
61 | } *sbus_actions; | 55 | static unsigned char board_to_cpu[32]; |
62 | 56 | ||
63 | static int pil_to_sbus[] = { | 57 | static int pil_to_sbus[] = { |
64 | 0, | 58 | 0, |
@@ -79,152 +73,81 @@ static int pil_to_sbus[] = { | |||
79 | 0, | 73 | 0, |
80 | }; | 74 | }; |
81 | 75 | ||
82 | static int sbus_to_pil[] = { | ||
83 | 0, | ||
84 | 2, | ||
85 | 3, | ||
86 | 5, | ||
87 | 7, | ||
88 | 9, | ||
89 | 11, | ||
90 | 13, | ||
91 | }; | ||
92 | |||
93 | static int nsbi; | ||
94 | |||
95 | /* Exported for sun4d_smp.c */ | 76 | /* Exported for sun4d_smp.c */ |
96 | DEFINE_SPINLOCK(sun4d_imsk_lock); | 77 | DEFINE_SPINLOCK(sun4d_imsk_lock); |
97 | 78 | ||
98 | int show_sun4d_interrupts(struct seq_file *p, void *v) | 79 | /* SBUS interrupts are encoded integers including the board number |
80 | * (plus one), the SBUS level, and the SBUS slot number. Sun4D | ||
81 | * IRQ dispatch is done by: | ||
82 | * | ||
83 | * 1) Reading the BW local interrupt table in order to get the bus | ||
84 | * interrupt mask. | ||
85 | * | ||
86 | * This table is indexed by SBUS interrupt level which can be | ||
87 | * derived from the PIL we got interrupted on. | ||
88 | * | ||
89 | * 2) For each bus showing interrupt pending from #1, read the | ||
90 | * SBI interrupt state register. This will indicate which slots | ||
91 | * have interrupts pending for that SBUS interrupt level. | ||
92 | * | ||
93 | * 3) Call the genreric IRQ support. | ||
94 | */ | ||
95 | static void sun4d_sbus_handler_irq(int sbusl) | ||
99 | { | 96 | { |
100 | int i = *(loff_t *) v, j = 0, k = 0, sbusl; | 97 | unsigned int bus_mask; |
101 | struct irqaction *action; | 98 | unsigned int sbino, slot; |
102 | unsigned long flags; | 99 | unsigned int sbil; |
103 | #ifdef CONFIG_SMP | 100 | |
104 | int x; | 101 | bus_mask = bw_get_intr_mask(sbusl) & 0x3ffff; |
105 | #endif | 102 | bw_clear_intr_mask(sbusl, bus_mask); |
106 | 103 | ||
107 | spin_lock_irqsave(&irq_action_lock, flags); | 104 | sbil = (sbusl << 2); |
108 | if (i < NR_IRQS) { | 105 | /* Loop for each pending SBI */ |
109 | sbusl = pil_to_sbus[i]; | 106 | for (sbino = 0; bus_mask; sbino++) { |
110 | if (!sbusl) { | 107 | unsigned int idx, mask; |
111 | action = *(i + irq_action); | 108 | |
112 | if (!action) | 109 | bus_mask >>= 1; |
113 | goto out_unlock; | 110 | if (!(bus_mask & 1)) |
114 | } else { | 111 | continue; |
115 | for (j = 0; j < nsbi; j++) { | 112 | /* XXX This seems to ACK the irq twice. acquire_sbi() |
116 | for (k = 0; k < 4; k++) | 113 | * XXX uses swap, therefore this writes 0xf << sbil, |
117 | action = sbus_actions[(j << 5) + (sbusl << 2) + k].action; | 114 | * XXX then later release_sbi() will write the individual |
118 | if (action) | 115 | * XXX bits which were set again. |
119 | goto found_it; | 116 | */ |
120 | } | 117 | mask = acquire_sbi(SBI2DEVID(sbino), 0xf << sbil); |
121 | goto out_unlock; | 118 | mask &= (0xf << sbil); |
122 | } | 119 | |
123 | found_it: seq_printf(p, "%3d: ", i); | 120 | /* Loop for each pending SBI slot */ |
124 | #ifndef CONFIG_SMP | 121 | idx = 0; |
125 | seq_printf(p, "%10u ", kstat_irqs(i)); | 122 | slot = (1 << sbil); |
126 | #else | 123 | while (mask != 0) { |
127 | for_each_online_cpu(x) | 124 | unsigned int pil; |
128 | seq_printf(p, "%10u ", | 125 | struct irq_bucket *p; |
129 | kstat_cpu(cpu_logical_map(x)).irqs[i]); | 126 | |
130 | #endif | 127 | idx++; |
131 | seq_printf(p, "%c %s", | 128 | slot <<= 1; |
132 | (action->flags & IRQF_DISABLED) ? '+' : ' ', | 129 | if (!(mask & slot)) |
133 | action->name); | 130 | continue; |
134 | action = action->next; | 131 | |
135 | for (;;) { | 132 | mask &= ~slot; |
136 | for (; action; action = action->next) { | 133 | pil = sun4d_encode_irq(sbino, sbil, idx); |
137 | seq_printf(p, ",%s %s", | 134 | |
138 | (action->flags & IRQF_DISABLED) ? " +" : "", | 135 | p = irq_map[pil]; |
139 | action->name); | 136 | while (p) { |
140 | } | 137 | struct irq_bucket *next; |
141 | if (!sbusl) | 138 | |
142 | break; | 139 | next = p->next; |
143 | k++; | 140 | generic_handle_irq(p->irq); |
144 | if (k < 4) { | 141 | p = next; |
145 | action = sbus_actions[(j << 5) + (sbusl << 2) + k].action; | ||
146 | } else { | ||
147 | j++; | ||
148 | if (j == nsbi) | ||
149 | break; | ||
150 | k = 0; | ||
151 | action = sbus_actions[(j << 5) + (sbusl << 2)].action; | ||
152 | } | 142 | } |
143 | release_sbi(SBI2DEVID(sbino), slot); | ||
153 | } | 144 | } |
154 | seq_putc(p, '\n'); | ||
155 | } | 145 | } |
156 | out_unlock: | ||
157 | spin_unlock_irqrestore(&irq_action_lock, flags); | ||
158 | return 0; | ||
159 | } | ||
160 | |||
161 | void sun4d_free_irq(unsigned int irq, void *dev_id) | ||
162 | { | ||
163 | struct irqaction *action, **actionp; | ||
164 | struct irqaction *tmp = NULL; | ||
165 | unsigned long flags; | ||
166 | |||
167 | spin_lock_irqsave(&irq_action_lock, flags); | ||
168 | if (irq < 15) | ||
169 | actionp = irq + irq_action; | ||
170 | else | ||
171 | actionp = &(sbus_actions[irq - (1 << 5)].action); | ||
172 | action = *actionp; | ||
173 | if (!action) { | ||
174 | printk(KERN_ERR "Trying to free free IRQ%d\n", irq); | ||
175 | goto out_unlock; | ||
176 | } | ||
177 | if (dev_id) { | ||
178 | for (; action; action = action->next) { | ||
179 | if (action->dev_id == dev_id) | ||
180 | break; | ||
181 | tmp = action; | ||
182 | } | ||
183 | if (!action) { | ||
184 | printk(KERN_ERR "Trying to free free shared IRQ%d\n", | ||
185 | irq); | ||
186 | goto out_unlock; | ||
187 | } | ||
188 | } else if (action->flags & IRQF_SHARED) { | ||
189 | printk(KERN_ERR "Trying to free shared IRQ%d with NULL device ID\n", | ||
190 | irq); | ||
191 | goto out_unlock; | ||
192 | } | ||
193 | if (action->flags & SA_STATIC_ALLOC) { | ||
194 | /* | ||
195 | * This interrupt is marked as specially allocated | ||
196 | * so it is a bad idea to free it. | ||
197 | */ | ||
198 | printk(KERN_ERR "Attempt to free statically allocated IRQ%d (%s)\n", | ||
199 | irq, action->name); | ||
200 | goto out_unlock; | ||
201 | } | ||
202 | |||
203 | if (tmp) | ||
204 | tmp->next = action->next; | ||
205 | else | ||
206 | *actionp = action->next; | ||
207 | |||
208 | spin_unlock_irqrestore(&irq_action_lock, flags); | ||
209 | |||
210 | synchronize_irq(irq); | ||
211 | |||
212 | spin_lock_irqsave(&irq_action_lock, flags); | ||
213 | |||
214 | kfree(action); | ||
215 | |||
216 | if (!(*actionp)) | ||
217 | __disable_irq(irq); | ||
218 | |||
219 | out_unlock: | ||
220 | spin_unlock_irqrestore(&irq_action_lock, flags); | ||
221 | } | 146 | } |
222 | 147 | ||
223 | void sun4d_handler_irq(int pil, struct pt_regs *regs) | 148 | void sun4d_handler_irq(int pil, struct pt_regs *regs) |
224 | { | 149 | { |
225 | struct pt_regs *old_regs; | 150 | struct pt_regs *old_regs; |
226 | struct irqaction *action; | ||
227 | int cpu = smp_processor_id(); | ||
228 | /* SBUS IRQ level (1 - 7) */ | 151 | /* SBUS IRQ level (1 - 7) */ |
229 | int sbusl = pil_to_sbus[pil]; | 152 | int sbusl = pil_to_sbus[pil]; |
230 | 153 | ||
@@ -233,160 +156,96 @@ void sun4d_handler_irq(int pil, struct pt_regs *regs) | |||
233 | 156 | ||
234 | cc_set_iclr(1 << pil); | 157 | cc_set_iclr(1 << pil); |
235 | 158 | ||
159 | #ifdef CONFIG_SMP | ||
160 | /* | ||
161 | * Check IPI data structures after IRQ has been cleared. Hard and Soft | ||
162 | * IRQ can happen at the same time, so both cases are always handled. | ||
163 | */ | ||
164 | if (pil == SUN4D_IPI_IRQ) | ||
165 | sun4d_ipi_interrupt(); | ||
166 | #endif | ||
167 | |||
236 | old_regs = set_irq_regs(regs); | 168 | old_regs = set_irq_regs(regs); |
237 | irq_enter(); | 169 | irq_enter(); |
238 | kstat_cpu(cpu).irqs[pil]++; | 170 | if (sbusl == 0) { |
239 | if (!sbusl) { | 171 | /* cpu interrupt */ |
240 | action = *(pil + irq_action); | 172 | struct irq_bucket *p; |
241 | if (!action) | 173 | |
242 | unexpected_irq(pil, NULL, regs); | 174 | p = irq_map[pil]; |
243 | do { | 175 | while (p) { |
244 | action->handler(pil, action->dev_id); | 176 | struct irq_bucket *next; |
245 | action = action->next; | 177 | |
246 | } while (action); | 178 | next = p->next; |
179 | generic_handle_irq(p->irq); | ||
180 | p = next; | ||
181 | } | ||
247 | } else { | 182 | } else { |
248 | int bus_mask = bw_get_intr_mask(sbusl) & 0x3ffff; | 183 | /* SBUS interrupt */ |
249 | int sbino; | 184 | sun4d_sbus_handler_irq(sbusl); |
250 | struct sbus_action *actionp; | ||
251 | unsigned mask, slot; | ||
252 | int sbil = (sbusl << 2); | ||
253 | |||
254 | bw_clear_intr_mask(sbusl, bus_mask); | ||
255 | |||
256 | /* Loop for each pending SBI */ | ||
257 | for (sbino = 0; bus_mask; sbino++, bus_mask >>= 1) | ||
258 | if (bus_mask & 1) { | ||
259 | mask = acquire_sbi(SBI2DEVID(sbino), 0xf << sbil); | ||
260 | mask &= (0xf << sbil); | ||
261 | actionp = sbus_actions + (sbino << 5) + (sbil); | ||
262 | /* Loop for each pending SBI slot */ | ||
263 | for (slot = (1 << sbil); mask; slot <<= 1, actionp++) | ||
264 | if (mask & slot) { | ||
265 | mask &= ~slot; | ||
266 | action = actionp->action; | ||
267 | |||
268 | if (!action) | ||
269 | unexpected_irq(pil, NULL, regs); | ||
270 | do { | ||
271 | action->handler(pil, action->dev_id); | ||
272 | action = action->next; | ||
273 | } while (action); | ||
274 | release_sbi(SBI2DEVID(sbino), slot); | ||
275 | } | ||
276 | } | ||
277 | } | 185 | } |
278 | irq_exit(); | 186 | irq_exit(); |
279 | set_irq_regs(old_regs); | 187 | set_irq_regs(old_regs); |
280 | } | 188 | } |
281 | 189 | ||
282 | int sun4d_request_irq(unsigned int irq, | 190 | |
283 | irq_handler_t handler, | 191 | static void sun4d_mask_irq(struct irq_data *data) |
284 | unsigned long irqflags, const char *devname, void *dev_id) | ||
285 | { | 192 | { |
286 | struct irqaction *action, *tmp = NULL, **actionp; | 193 | struct sun4d_handler_data *handler_data = data->handler_data; |
194 | unsigned int real_irq; | ||
195 | #ifdef CONFIG_SMP | ||
196 | int cpuid = handler_data->cpuid; | ||
287 | unsigned long flags; | 197 | unsigned long flags; |
288 | int ret; | 198 | #endif |
289 | 199 | real_irq = handler_data->real_irq; | |
290 | if (irq > 14 && irq < (1 << 5)) { | 200 | #ifdef CONFIG_SMP |
291 | ret = -EINVAL; | 201 | spin_lock_irqsave(&sun4d_imsk_lock, flags); |
292 | goto out; | 202 | cc_set_imsk_other(cpuid, cc_get_imsk_other(cpuid) | (1 << real_irq)); |
293 | } | 203 | spin_unlock_irqrestore(&sun4d_imsk_lock, flags); |
294 | 204 | #else | |
295 | if (!handler) { | 205 | cc_set_imsk(cc_get_imsk() | (1 << real_irq)); |
296 | ret = -EINVAL; | 206 | #endif |
297 | goto out; | ||
298 | } | ||
299 | |||
300 | spin_lock_irqsave(&irq_action_lock, flags); | ||
301 | |||
302 | if (irq >= (1 << 5)) | ||
303 | actionp = &(sbus_actions[irq - (1 << 5)].action); | ||
304 | else | ||
305 | actionp = irq + irq_action; | ||
306 | action = *actionp; | ||
307 | |||
308 | if (action) { | ||
309 | if ((action->flags & IRQF_SHARED) && (irqflags & IRQF_SHARED)) { | ||
310 | for (tmp = action; tmp->next; tmp = tmp->next) | ||
311 | /* find last entry - tmp used below */; | ||
312 | } else { | ||
313 | ret = -EBUSY; | ||
314 | goto out_unlock; | ||
315 | } | ||
316 | if ((action->flags & IRQF_DISABLED) ^ (irqflags & IRQF_DISABLED)) { | ||
317 | printk(KERN_ERR "Attempt to mix fast and slow interrupts on IRQ%d denied\n", | ||
318 | irq); | ||
319 | ret = -EBUSY; | ||
320 | goto out_unlock; | ||
321 | } | ||
322 | action = NULL; /* Or else! */ | ||
323 | } | ||
324 | |||
325 | /* If this is flagged as statically allocated then we use our | ||
326 | * private struct which is never freed. | ||
327 | */ | ||
328 | if (irqflags & SA_STATIC_ALLOC) { | ||
329 | if (static_irq_count < MAX_STATIC_ALLOC) | ||
330 | action = &static_irqaction[static_irq_count++]; | ||
331 | else | ||
332 | printk(KERN_ERR "Request for IRQ%d (%s) SA_STATIC_ALLOC failed using kmalloc\n", | ||
333 | irq, devname); | ||
334 | } | ||
335 | |||
336 | if (action == NULL) | ||
337 | action = kmalloc(sizeof(struct irqaction), GFP_ATOMIC); | ||
338 | |||
339 | if (!action) { | ||
340 | ret = -ENOMEM; | ||
341 | goto out_unlock; | ||
342 | } | ||
343 | |||
344 | action->handler = handler; | ||
345 | action->flags = irqflags; | ||
346 | action->name = devname; | ||
347 | action->next = NULL; | ||
348 | action->dev_id = dev_id; | ||
349 | |||
350 | if (tmp) | ||
351 | tmp->next = action; | ||
352 | else | ||
353 | *actionp = action; | ||
354 | |||
355 | __enable_irq(irq); | ||
356 | |||
357 | ret = 0; | ||
358 | out_unlock: | ||
359 | spin_unlock_irqrestore(&irq_action_lock, flags); | ||
360 | out: | ||
361 | return ret; | ||
362 | } | 207 | } |
363 | 208 | ||
364 | static void sun4d_disable_irq(unsigned int irq) | 209 | static void sun4d_unmask_irq(struct irq_data *data) |
365 | { | 210 | { |
366 | int tid = sbus_tid[(irq >> 5) - 1]; | 211 | struct sun4d_handler_data *handler_data = data->handler_data; |
212 | unsigned int real_irq; | ||
213 | #ifdef CONFIG_SMP | ||
214 | int cpuid = handler_data->cpuid; | ||
367 | unsigned long flags; | 215 | unsigned long flags; |
216 | #endif | ||
217 | real_irq = handler_data->real_irq; | ||
368 | 218 | ||
369 | if (irq < NR_IRQS) | 219 | #ifdef CONFIG_SMP |
370 | return; | ||
371 | |||
372 | spin_lock_irqsave(&sun4d_imsk_lock, flags); | 220 | spin_lock_irqsave(&sun4d_imsk_lock, flags); |
373 | cc_set_imsk_other(tid, cc_get_imsk_other(tid) | (1 << sbus_to_pil[(irq >> 2) & 7])); | 221 | cc_set_imsk_other(cpuid, cc_get_imsk_other(cpuid) | ~(1 << real_irq)); |
374 | spin_unlock_irqrestore(&sun4d_imsk_lock, flags); | 222 | spin_unlock_irqrestore(&sun4d_imsk_lock, flags); |
223 | #else | ||
224 | cc_set_imsk(cc_get_imsk() | ~(1 << real_irq)); | ||
225 | #endif | ||
375 | } | 226 | } |
376 | 227 | ||
377 | static void sun4d_enable_irq(unsigned int irq) | 228 | static unsigned int sun4d_startup_irq(struct irq_data *data) |
378 | { | 229 | { |
379 | int tid = sbus_tid[(irq >> 5) - 1]; | 230 | irq_link(data->irq); |
380 | unsigned long flags; | 231 | sun4d_unmask_irq(data); |
381 | 232 | return 0; | |
382 | if (irq < NR_IRQS) | 233 | } |
383 | return; | ||
384 | 234 | ||
385 | spin_lock_irqsave(&sun4d_imsk_lock, flags); | 235 | static void sun4d_shutdown_irq(struct irq_data *data) |
386 | cc_set_imsk_other(tid, cc_get_imsk_other(tid) & ~(1 << sbus_to_pil[(irq >> 2) & 7])); | 236 | { |
387 | spin_unlock_irqrestore(&sun4d_imsk_lock, flags); | 237 | sun4d_mask_irq(data); |
238 | irq_unlink(data->irq); | ||
388 | } | 239 | } |
389 | 240 | ||
241 | struct irq_chip sun4d_irq = { | ||
242 | .name = "sun4d", | ||
243 | .irq_startup = sun4d_startup_irq, | ||
244 | .irq_shutdown = sun4d_shutdown_irq, | ||
245 | .irq_unmask = sun4d_unmask_irq, | ||
246 | .irq_mask = sun4d_mask_irq, | ||
247 | }; | ||
248 | |||
390 | #ifdef CONFIG_SMP | 249 | #ifdef CONFIG_SMP |
391 | static void sun4d_set_cpu_int(int cpu, int level) | 250 | static void sun4d_set_cpu_int(int cpu, int level) |
392 | { | 251 | { |
@@ -413,7 +272,7 @@ void __init sun4d_distribute_irqs(void) | |||
413 | for_each_node_by_name(dp, "sbi") { | 272 | for_each_node_by_name(dp, "sbi") { |
414 | int devid = of_getintprop_default(dp, "device-id", 0); | 273 | int devid = of_getintprop_default(dp, "device-id", 0); |
415 | int board = of_getintprop_default(dp, "board#", 0); | 274 | int board = of_getintprop_default(dp, "board#", 0); |
416 | sbus_tid[board] = cpuid; | 275 | board_to_cpu[board] = cpuid; |
417 | set_sbi_tid(devid, cpuid << 3); | 276 | set_sbi_tid(devid, cpuid << 3); |
418 | } | 277 | } |
419 | printk(KERN_ERR "All sbus IRQs directed to CPU%d\n", cpuid); | 278 | printk(KERN_ERR "All sbus IRQs directed to CPU%d\n", cpuid); |
@@ -443,15 +302,16 @@ static void __init sun4d_load_profile_irqs(void) | |||
443 | unsigned int sun4d_build_device_irq(struct platform_device *op, | 302 | unsigned int sun4d_build_device_irq(struct platform_device *op, |
444 | unsigned int real_irq) | 303 | unsigned int real_irq) |
445 | { | 304 | { |
446 | static int pil_to_sbus[] = { | ||
447 | 0, 0, 1, 2, 0, 3, 0, 4, 0, 5, 0, 6, 0, 7, 0, 0, | ||
448 | }; | ||
449 | struct device_node *dp = op->dev.of_node; | 305 | struct device_node *dp = op->dev.of_node; |
450 | struct device_node *io_unit, *sbi = dp->parent; | 306 | struct device_node *io_unit, *sbi = dp->parent; |
451 | const struct linux_prom_registers *regs; | 307 | const struct linux_prom_registers *regs; |
308 | struct sun4d_handler_data *handler_data; | ||
309 | unsigned int pil; | ||
310 | unsigned int irq; | ||
452 | int board, slot; | 311 | int board, slot; |
453 | int sbusl; | 312 | int sbusl; |
454 | 313 | ||
314 | irq = 0; | ||
455 | while (sbi) { | 315 | while (sbi) { |
456 | if (!strcmp(sbi->name, "sbi")) | 316 | if (!strcmp(sbi->name, "sbi")) |
457 | break; | 317 | break; |
@@ -484,7 +344,28 @@ unsigned int sun4d_build_device_irq(struct platform_device *op, | |||
484 | 344 | ||
485 | sbusl = pil_to_sbus[real_irq]; | 345 | sbusl = pil_to_sbus[real_irq]; |
486 | if (sbusl) | 346 | if (sbusl) |
487 | return (((board + 1) << 5) + (sbusl << 2) + slot); | 347 | pil = sun4d_encode_irq(board, sbusl, slot); |
348 | else | ||
349 | pil = real_irq; | ||
350 | |||
351 | irq = irq_alloc(real_irq, pil); | ||
352 | if (irq == 0) | ||
353 | goto err_out; | ||
354 | |||
355 | handler_data = irq_get_handler_data(irq); | ||
356 | if (unlikely(handler_data)) | ||
357 | goto err_out; | ||
358 | |||
359 | handler_data = kzalloc(sizeof(struct sun4d_handler_data), GFP_ATOMIC); | ||
360 | if (unlikely(!handler_data)) { | ||
361 | prom_printf("IRQ: kzalloc(sun4d_handler_data) failed.\n"); | ||
362 | prom_halt(); | ||
363 | } | ||
364 | handler_data->cpuid = board_to_cpu[board]; | ||
365 | handler_data->real_irq = real_irq; | ||
366 | irq_set_chip_and_handler_name(irq, &sun4d_irq, | ||
367 | handle_level_irq, "level"); | ||
368 | irq_set_handler_data(irq, handler_data); | ||
488 | 369 | ||
489 | err_out: | 370 | err_out: |
490 | return real_irq; | 371 | return real_irq; |
@@ -518,6 +399,7 @@ static void __init sun4d_init_timers(irq_handler_t counter_fn) | |||
518 | { | 399 | { |
519 | struct device_node *dp; | 400 | struct device_node *dp; |
520 | struct resource res; | 401 | struct resource res; |
402 | unsigned int irq; | ||
521 | const u32 *reg; | 403 | const u32 *reg; |
522 | int err; | 404 | int err; |
523 | 405 | ||
@@ -552,9 +434,8 @@ static void __init sun4d_init_timers(irq_handler_t counter_fn) | |||
552 | 434 | ||
553 | master_l10_counter = &sun4d_timers->l10_cur_count; | 435 | master_l10_counter = &sun4d_timers->l10_cur_count; |
554 | 436 | ||
555 | err = request_irq(TIMER_IRQ, counter_fn, | 437 | irq = sun4d_build_device_irq(NULL, SUN4D_TIMER_IRQ); |
556 | (IRQF_DISABLED | SA_STATIC_ALLOC), | 438 | err = request_irq(irq, counter_fn, IRQF_TIMER, "timer", NULL); |
557 | "timer", NULL); | ||
558 | if (err) { | 439 | if (err) { |
559 | prom_printf("sun4d_init_timers: request_irq() failed with %d\n", | 440 | prom_printf("sun4d_init_timers: request_irq() failed with %d\n", |
560 | err); | 441 | err); |
@@ -567,27 +448,16 @@ static void __init sun4d_init_timers(irq_handler_t counter_fn) | |||
567 | void __init sun4d_init_sbi_irq(void) | 448 | void __init sun4d_init_sbi_irq(void) |
568 | { | 449 | { |
569 | struct device_node *dp; | 450 | struct device_node *dp; |
570 | int target_cpu = 0; | 451 | int target_cpu; |
571 | 452 | ||
572 | #ifdef CONFIG_SMP | ||
573 | target_cpu = boot_cpu_id; | 453 | target_cpu = boot_cpu_id; |
574 | #endif | ||
575 | |||
576 | nsbi = 0; | ||
577 | for_each_node_by_name(dp, "sbi") | ||
578 | nsbi++; | ||
579 | sbus_actions = kzalloc(nsbi * 8 * 4 * sizeof(struct sbus_action), GFP_ATOMIC); | ||
580 | if (!sbus_actions) { | ||
581 | prom_printf("SUN4D: Cannot allocate sbus_actions, halting.\n"); | ||
582 | prom_halt(); | ||
583 | } | ||
584 | for_each_node_by_name(dp, "sbi") { | 454 | for_each_node_by_name(dp, "sbi") { |
585 | int devid = of_getintprop_default(dp, "device-id", 0); | 455 | int devid = of_getintprop_default(dp, "device-id", 0); |
586 | int board = of_getintprop_default(dp, "board#", 0); | 456 | int board = of_getintprop_default(dp, "board#", 0); |
587 | unsigned int mask; | 457 | unsigned int mask; |
588 | 458 | ||
589 | set_sbi_tid(devid, target_cpu << 3); | 459 | set_sbi_tid(devid, target_cpu << 3); |
590 | sbus_tid[board] = target_cpu; | 460 | board_to_cpu[board] = target_cpu; |
591 | 461 | ||
592 | /* Get rid of pending irqs from PROM */ | 462 | /* Get rid of pending irqs from PROM */ |
593 | mask = acquire_sbi(devid, 0xffffffff); | 463 | mask = acquire_sbi(devid, 0xffffffff); |
@@ -603,12 +473,10 @@ void __init sun4d_init_IRQ(void) | |||
603 | { | 473 | { |
604 | local_irq_disable(); | 474 | local_irq_disable(); |
605 | 475 | ||
606 | BTFIXUPSET_CALL(enable_irq, sun4d_enable_irq, BTFIXUPCALL_NORM); | ||
607 | BTFIXUPSET_CALL(disable_irq, sun4d_disable_irq, BTFIXUPCALL_NORM); | ||
608 | BTFIXUPSET_CALL(clear_clock_irq, sun4d_clear_clock_irq, BTFIXUPCALL_NORM); | 476 | BTFIXUPSET_CALL(clear_clock_irq, sun4d_clear_clock_irq, BTFIXUPCALL_NORM); |
609 | BTFIXUPSET_CALL(load_profile_irq, sun4d_load_profile_irq, BTFIXUPCALL_NORM); | 477 | BTFIXUPSET_CALL(load_profile_irq, sun4d_load_profile_irq, BTFIXUPCALL_NORM); |
610 | 478 | ||
611 | sparc_irq_config.init_timers = sun4d_init_timers; | 479 | sparc_irq_config.init_timers = sun4d_init_timers; |
612 | sparc_irq_config.build_device_irq = sun4d_build_device_irq; | 480 | sparc_irq_config.build_device_irq = sun4d_build_device_irq; |
613 | 481 | ||
614 | #ifdef CONFIG_SMP | 482 | #ifdef CONFIG_SMP |
diff --git a/arch/sparc/kernel/sun4d_smp.c b/arch/sparc/kernel/sun4d_smp.c index 475d50b96cd0..133387980b56 100644 --- a/arch/sparc/kernel/sun4d_smp.c +++ b/arch/sparc/kernel/sun4d_smp.c | |||
@@ -32,6 +32,7 @@ static inline unsigned long sun4d_swap(volatile unsigned long *ptr, unsigned lon | |||
32 | return val; | 32 | return val; |
33 | } | 33 | } |
34 | 34 | ||
35 | static void smp4d_ipi_init(void); | ||
35 | static void smp_setup_percpu_timer(void); | 36 | static void smp_setup_percpu_timer(void); |
36 | 37 | ||
37 | static unsigned char cpu_leds[32]; | 38 | static unsigned char cpu_leds[32]; |
@@ -80,8 +81,6 @@ void __cpuinit smp4d_callin(void) | |||
80 | local_flush_cache_all(); | 81 | local_flush_cache_all(); |
81 | local_flush_tlb_all(); | 82 | local_flush_tlb_all(); |
82 | 83 | ||
83 | cpu_probe(); | ||
84 | |||
85 | while ((unsigned long)current_set[cpuid] < PAGE_OFFSET) | 84 | while ((unsigned long)current_set[cpuid] < PAGE_OFFSET) |
86 | barrier(); | 85 | barrier(); |
87 | 86 | ||
@@ -105,7 +104,7 @@ void __cpuinit smp4d_callin(void) | |||
105 | 104 | ||
106 | local_irq_enable(); /* We don't allow PIL 14 yet */ | 105 | local_irq_enable(); /* We don't allow PIL 14 yet */ |
107 | 106 | ||
108 | while (!cpu_isset(cpuid, smp_commenced_mask)) | 107 | while (!cpumask_test_cpu(cpuid, &smp_commenced_mask)) |
109 | barrier(); | 108 | barrier(); |
110 | 109 | ||
111 | spin_lock_irqsave(&sun4d_imsk_lock, flags); | 110 | spin_lock_irqsave(&sun4d_imsk_lock, flags); |
@@ -120,6 +119,7 @@ void __cpuinit smp4d_callin(void) | |||
120 | */ | 119 | */ |
121 | void __init smp4d_boot_cpus(void) | 120 | void __init smp4d_boot_cpus(void) |
122 | { | 121 | { |
122 | smp4d_ipi_init(); | ||
123 | if (boot_cpu_id) | 123 | if (boot_cpu_id) |
124 | current_set[0] = NULL; | 124 | current_set[0] = NULL; |
125 | smp_setup_percpu_timer(); | 125 | smp_setup_percpu_timer(); |
@@ -191,6 +191,80 @@ void __init smp4d_smp_done(void) | |||
191 | sun4d_distribute_irqs(); | 191 | sun4d_distribute_irqs(); |
192 | } | 192 | } |
193 | 193 | ||
194 | /* Memory structure giving interrupt handler information about IPI generated */ | ||
195 | struct sun4d_ipi_work { | ||
196 | int single; | ||
197 | int msk; | ||
198 | int resched; | ||
199 | }; | ||
200 | |||
201 | static DEFINE_PER_CPU_SHARED_ALIGNED(struct sun4d_ipi_work, sun4d_ipi_work); | ||
202 | |||
203 | /* Initialize IPIs on the SUN4D SMP machine */ | ||
204 | static void __init smp4d_ipi_init(void) | ||
205 | { | ||
206 | int cpu; | ||
207 | struct sun4d_ipi_work *work; | ||
208 | |||
209 | printk(KERN_INFO "smp4d: setup IPI at IRQ %d\n", SUN4D_IPI_IRQ); | ||
210 | |||
211 | for_each_possible_cpu(cpu) { | ||
212 | work = &per_cpu(sun4d_ipi_work, cpu); | ||
213 | work->single = work->msk = work->resched = 0; | ||
214 | } | ||
215 | } | ||
216 | |||
217 | void sun4d_ipi_interrupt(void) | ||
218 | { | ||
219 | struct sun4d_ipi_work *work = &__get_cpu_var(sun4d_ipi_work); | ||
220 | |||
221 | if (work->single) { | ||
222 | work->single = 0; | ||
223 | smp_call_function_single_interrupt(); | ||
224 | } | ||
225 | if (work->msk) { | ||
226 | work->msk = 0; | ||
227 | smp_call_function_interrupt(); | ||
228 | } | ||
229 | if (work->resched) { | ||
230 | work->resched = 0; | ||
231 | smp_resched_interrupt(); | ||
232 | } | ||
233 | } | ||
234 | |||
235 | static void smp4d_ipi_single(int cpu) | ||
236 | { | ||
237 | struct sun4d_ipi_work *work = &per_cpu(sun4d_ipi_work, cpu); | ||
238 | |||
239 | /* Mark work */ | ||
240 | work->single = 1; | ||
241 | |||
242 | /* Generate IRQ on the CPU */ | ||
243 | sun4d_send_ipi(cpu, SUN4D_IPI_IRQ); | ||
244 | } | ||
245 | |||
246 | static void smp4d_ipi_mask_one(int cpu) | ||
247 | { | ||
248 | struct sun4d_ipi_work *work = &per_cpu(sun4d_ipi_work, cpu); | ||
249 | |||
250 | /* Mark work */ | ||
251 | work->msk = 1; | ||
252 | |||
253 | /* Generate IRQ on the CPU */ | ||
254 | sun4d_send_ipi(cpu, SUN4D_IPI_IRQ); | ||
255 | } | ||
256 | |||
257 | static void smp4d_ipi_resched(int cpu) | ||
258 | { | ||
259 | struct sun4d_ipi_work *work = &per_cpu(sun4d_ipi_work, cpu); | ||
260 | |||
261 | /* Mark work */ | ||
262 | work->resched = 1; | ||
263 | |||
264 | /* Generate IRQ on the CPU (any IRQ will cause resched) */ | ||
265 | sun4d_send_ipi(cpu, SUN4D_IPI_IRQ); | ||
266 | } | ||
267 | |||
194 | static struct smp_funcall { | 268 | static struct smp_funcall { |
195 | smpfunc_t func; | 269 | smpfunc_t func; |
196 | unsigned long arg1; | 270 | unsigned long arg1; |
@@ -239,10 +313,10 @@ static void smp4d_cross_call(smpfunc_t func, cpumask_t mask, unsigned long arg1, | |||
239 | { | 313 | { |
240 | register int i; | 314 | register int i; |
241 | 315 | ||
242 | cpu_clear(smp_processor_id(), mask); | 316 | cpumask_clear_cpu(smp_processor_id(), &mask); |
243 | cpus_and(mask, cpu_online_map, mask); | 317 | cpumask_and(&mask, cpu_online_mask, &mask); |
244 | for (i = 0; i <= high; i++) { | 318 | for (i = 0; i <= high; i++) { |
245 | if (cpu_isset(i, mask)) { | 319 | if (cpumask_test_cpu(i, &mask)) { |
246 | ccall_info.processors_in[i] = 0; | 320 | ccall_info.processors_in[i] = 0; |
247 | ccall_info.processors_out[i] = 0; | 321 | ccall_info.processors_out[i] = 0; |
248 | sun4d_send_ipi(i, IRQ_CROSS_CALL); | 322 | sun4d_send_ipi(i, IRQ_CROSS_CALL); |
@@ -255,7 +329,7 @@ static void smp4d_cross_call(smpfunc_t func, cpumask_t mask, unsigned long arg1, | |||
255 | 329 | ||
256 | i = 0; | 330 | i = 0; |
257 | do { | 331 | do { |
258 | if (!cpu_isset(i, mask)) | 332 | if (!cpumask_test_cpu(i, &mask)) |
259 | continue; | 333 | continue; |
260 | while (!ccall_info.processors_in[i]) | 334 | while (!ccall_info.processors_in[i]) |
261 | barrier(); | 335 | barrier(); |
@@ -263,7 +337,7 @@ static void smp4d_cross_call(smpfunc_t func, cpumask_t mask, unsigned long arg1, | |||
263 | 337 | ||
264 | i = 0; | 338 | i = 0; |
265 | do { | 339 | do { |
266 | if (!cpu_isset(i, mask)) | 340 | if (!cpumask_test_cpu(i, &mask)) |
267 | continue; | 341 | continue; |
268 | while (!ccall_info.processors_out[i]) | 342 | while (!ccall_info.processors_out[i]) |
269 | barrier(); | 343 | barrier(); |
@@ -356,6 +430,9 @@ void __init sun4d_init_smp(void) | |||
356 | BTFIXUPSET_BLACKBOX(load_current, smp4d_blackbox_current); | 430 | BTFIXUPSET_BLACKBOX(load_current, smp4d_blackbox_current); |
357 | BTFIXUPSET_CALL(smp_cross_call, smp4d_cross_call, BTFIXUPCALL_NORM); | 431 | BTFIXUPSET_CALL(smp_cross_call, smp4d_cross_call, BTFIXUPCALL_NORM); |
358 | BTFIXUPSET_CALL(__hard_smp_processor_id, __smp4d_processor_id, BTFIXUPCALL_NORM); | 432 | BTFIXUPSET_CALL(__hard_smp_processor_id, __smp4d_processor_id, BTFIXUPCALL_NORM); |
433 | BTFIXUPSET_CALL(smp_ipi_resched, smp4d_ipi_resched, BTFIXUPCALL_NORM); | ||
434 | BTFIXUPSET_CALL(smp_ipi_single, smp4d_ipi_single, BTFIXUPCALL_NORM); | ||
435 | BTFIXUPSET_CALL(smp_ipi_mask_one, smp4d_ipi_mask_one, BTFIXUPCALL_NORM); | ||
359 | 436 | ||
360 | for (i = 0; i < NR_CPUS; i++) { | 437 | for (i = 0; i < NR_CPUS; i++) { |
361 | ccall_info.processors_in[i] = 1; | 438 | ccall_info.processors_in[i] = 1; |
diff --git a/arch/sparc/kernel/sun4m_irq.c b/arch/sparc/kernel/sun4m_irq.c index 69df6257a32e..422c16dad1f6 100644 --- a/arch/sparc/kernel/sun4m_irq.c +++ b/arch/sparc/kernel/sun4m_irq.c | |||
@@ -100,6 +100,11 @@ | |||
100 | struct sun4m_irq_percpu __iomem *sun4m_irq_percpu[SUN4M_NCPUS]; | 100 | struct sun4m_irq_percpu __iomem *sun4m_irq_percpu[SUN4M_NCPUS]; |
101 | struct sun4m_irq_global __iomem *sun4m_irq_global; | 101 | struct sun4m_irq_global __iomem *sun4m_irq_global; |
102 | 102 | ||
103 | struct sun4m_handler_data { | ||
104 | bool percpu; | ||
105 | long mask; | ||
106 | }; | ||
107 | |||
103 | /* Dave Redman (djhr@tadpole.co.uk) | 108 | /* Dave Redman (djhr@tadpole.co.uk) |
104 | * The sun4m interrupt registers. | 109 | * The sun4m interrupt registers. |
105 | */ | 110 | */ |
@@ -142,9 +147,9 @@ struct sun4m_irq_global __iomem *sun4m_irq_global; | |||
142 | #define OBP_INT_LEVEL_VME 0x40 | 147 | #define OBP_INT_LEVEL_VME 0x40 |
143 | 148 | ||
144 | #define SUN4M_TIMER_IRQ (OBP_INT_LEVEL_ONBOARD | 10) | 149 | #define SUN4M_TIMER_IRQ (OBP_INT_LEVEL_ONBOARD | 10) |
145 | #define SUM4M_PROFILE_IRQ (OBP_INT_LEVEL_ONBOARD | 14) | 150 | #define SUN4M_PROFILE_IRQ (OBP_INT_LEVEL_ONBOARD | 14) |
146 | 151 | ||
147 | static unsigned long irq_mask[0x50] = { | 152 | static unsigned long sun4m_imask[0x50] = { |
148 | /* 0x00 - SMP */ | 153 | /* 0x00 - SMP */ |
149 | 0, SUN4M_SOFT_INT(1), | 154 | 0, SUN4M_SOFT_INT(1), |
150 | SUN4M_SOFT_INT(2), SUN4M_SOFT_INT(3), | 155 | SUN4M_SOFT_INT(2), SUN4M_SOFT_INT(3), |
@@ -169,7 +174,7 @@ static unsigned long irq_mask[0x50] = { | |||
169 | SUN4M_INT_VIDEO, SUN4M_INT_MODULE, | 174 | SUN4M_INT_VIDEO, SUN4M_INT_MODULE, |
170 | SUN4M_INT_REALTIME, SUN4M_INT_FLOPPY, | 175 | SUN4M_INT_REALTIME, SUN4M_INT_FLOPPY, |
171 | (SUN4M_INT_SERIAL | SUN4M_INT_KBDMS), | 176 | (SUN4M_INT_SERIAL | SUN4M_INT_KBDMS), |
172 | SUN4M_INT_AUDIO, 0, SUN4M_INT_MODULE_ERR, | 177 | SUN4M_INT_AUDIO, SUN4M_INT_E14, SUN4M_INT_MODULE_ERR, |
173 | /* 0x30 - sbus */ | 178 | /* 0x30 - sbus */ |
174 | 0, 0, SUN4M_INT_SBUS(0), SUN4M_INT_SBUS(1), | 179 | 0, 0, SUN4M_INT_SBUS(0), SUN4M_INT_SBUS(1), |
175 | 0, SUN4M_INT_SBUS(2), 0, SUN4M_INT_SBUS(3), | 180 | 0, SUN4M_INT_SBUS(2), 0, SUN4M_INT_SBUS(3), |
@@ -182,105 +187,110 @@ static unsigned long irq_mask[0x50] = { | |||
182 | 0, SUN4M_INT_VME(6), 0, 0 | 187 | 0, SUN4M_INT_VME(6), 0, 0 |
183 | }; | 188 | }; |
184 | 189 | ||
185 | static unsigned long sun4m_get_irqmask(unsigned int irq) | 190 | static void sun4m_mask_irq(struct irq_data *data) |
186 | { | 191 | { |
187 | unsigned long mask; | 192 | struct sun4m_handler_data *handler_data = data->handler_data; |
188 | 193 | int cpu = smp_processor_id(); | |
189 | if (irq < 0x50) | ||
190 | mask = irq_mask[irq]; | ||
191 | else | ||
192 | mask = 0; | ||
193 | 194 | ||
194 | if (!mask) | 195 | if (handler_data->mask) { |
195 | printk(KERN_ERR "sun4m_get_irqmask: IRQ%d has no valid mask!\n", | 196 | unsigned long flags; |
196 | irq); | ||
197 | 197 | ||
198 | return mask; | 198 | local_irq_save(flags); |
199 | if (handler_data->percpu) { | ||
200 | sbus_writel(handler_data->mask, &sun4m_irq_percpu[cpu]->set); | ||
201 | } else { | ||
202 | sbus_writel(handler_data->mask, &sun4m_irq_global->mask_set); | ||
203 | } | ||
204 | local_irq_restore(flags); | ||
205 | } | ||
199 | } | 206 | } |
200 | 207 | ||
201 | static void sun4m_disable_irq(unsigned int irq_nr) | 208 | static void sun4m_unmask_irq(struct irq_data *data) |
202 | { | 209 | { |
203 | unsigned long mask, flags; | 210 | struct sun4m_handler_data *handler_data = data->handler_data; |
204 | int cpu = smp_processor_id(); | 211 | int cpu = smp_processor_id(); |
205 | 212 | ||
206 | mask = sun4m_get_irqmask(irq_nr); | 213 | if (handler_data->mask) { |
207 | local_irq_save(flags); | 214 | unsigned long flags; |
208 | if (irq_nr > 15) | ||
209 | sbus_writel(mask, &sun4m_irq_global->mask_set); | ||
210 | else | ||
211 | sbus_writel(mask, &sun4m_irq_percpu[cpu]->set); | ||
212 | local_irq_restore(flags); | ||
213 | } | ||
214 | |||
215 | static void sun4m_enable_irq(unsigned int irq_nr) | ||
216 | { | ||
217 | unsigned long mask, flags; | ||
218 | int cpu = smp_processor_id(); | ||
219 | 215 | ||
220 | /* Dreadful floppy hack. When we use 0x2b instead of | ||
221 | * 0x0b the system blows (it starts to whistle!). | ||
222 | * So we continue to use 0x0b. Fixme ASAP. --P3 | ||
223 | */ | ||
224 | if (irq_nr != 0x0b) { | ||
225 | mask = sun4m_get_irqmask(irq_nr); | ||
226 | local_irq_save(flags); | ||
227 | if (irq_nr > 15) | ||
228 | sbus_writel(mask, &sun4m_irq_global->mask_clear); | ||
229 | else | ||
230 | sbus_writel(mask, &sun4m_irq_percpu[cpu]->clear); | ||
231 | local_irq_restore(flags); | ||
232 | } else { | ||
233 | local_irq_save(flags); | 216 | local_irq_save(flags); |
234 | sbus_writel(SUN4M_INT_FLOPPY, &sun4m_irq_global->mask_clear); | 217 | if (handler_data->percpu) { |
218 | sbus_writel(handler_data->mask, &sun4m_irq_percpu[cpu]->clear); | ||
219 | } else { | ||
220 | sbus_writel(handler_data->mask, &sun4m_irq_global->mask_clear); | ||
221 | } | ||
235 | local_irq_restore(flags); | 222 | local_irq_restore(flags); |
236 | } | 223 | } |
237 | } | 224 | } |
238 | 225 | ||
239 | static unsigned long cpu_pil_to_imask[16] = { | 226 | static unsigned int sun4m_startup_irq(struct irq_data *data) |
240 | /*0*/ 0x00000000, | 227 | { |
241 | /*1*/ 0x00000000, | 228 | irq_link(data->irq); |
242 | /*2*/ SUN4M_INT_SBUS(0) | SUN4M_INT_VME(0), | 229 | sun4m_unmask_irq(data); |
243 | /*3*/ SUN4M_INT_SBUS(1) | SUN4M_INT_VME(1), | 230 | return 0; |
244 | /*4*/ SUN4M_INT_SCSI, | 231 | } |
245 | /*5*/ SUN4M_INT_SBUS(2) | SUN4M_INT_VME(2), | ||
246 | /*6*/ SUN4M_INT_ETHERNET, | ||
247 | /*7*/ SUN4M_INT_SBUS(3) | SUN4M_INT_VME(3), | ||
248 | /*8*/ SUN4M_INT_VIDEO, | ||
249 | /*9*/ SUN4M_INT_SBUS(4) | SUN4M_INT_VME(4) | SUN4M_INT_MODULE_ERR, | ||
250 | /*10*/ SUN4M_INT_REALTIME, | ||
251 | /*11*/ SUN4M_INT_SBUS(5) | SUN4M_INT_VME(5) | SUN4M_INT_FLOPPY, | ||
252 | /*12*/ SUN4M_INT_SERIAL | SUN4M_INT_KBDMS, | ||
253 | /*13*/ SUN4M_INT_SBUS(6) | SUN4M_INT_VME(6) | SUN4M_INT_AUDIO, | ||
254 | /*14*/ SUN4M_INT_E14, | ||
255 | /*15*/ SUN4M_INT_ERROR, | ||
256 | }; | ||
257 | 232 | ||
258 | /* We assume the caller has disabled local interrupts when these are called, | 233 | static void sun4m_shutdown_irq(struct irq_data *data) |
259 | * or else very bizarre behavior will result. | ||
260 | */ | ||
261 | static void sun4m_disable_pil_irq(unsigned int pil) | ||
262 | { | 234 | { |
263 | sbus_writel(cpu_pil_to_imask[pil], &sun4m_irq_global->mask_set); | 235 | sun4m_mask_irq(data); |
236 | irq_unlink(data->irq); | ||
264 | } | 237 | } |
265 | 238 | ||
266 | static void sun4m_enable_pil_irq(unsigned int pil) | 239 | static struct irq_chip sun4m_irq = { |
240 | .name = "sun4m", | ||
241 | .irq_startup = sun4m_startup_irq, | ||
242 | .irq_shutdown = sun4m_shutdown_irq, | ||
243 | .irq_mask = sun4m_mask_irq, | ||
244 | .irq_unmask = sun4m_unmask_irq, | ||
245 | }; | ||
246 | |||
247 | |||
248 | static unsigned int sun4m_build_device_irq(struct platform_device *op, | ||
249 | unsigned int real_irq) | ||
267 | { | 250 | { |
268 | sbus_writel(cpu_pil_to_imask[pil], &sun4m_irq_global->mask_clear); | 251 | struct sun4m_handler_data *handler_data; |
252 | unsigned int irq; | ||
253 | unsigned int pil; | ||
254 | |||
255 | if (real_irq >= OBP_INT_LEVEL_VME) { | ||
256 | prom_printf("Bogus sun4m IRQ %u\n", real_irq); | ||
257 | prom_halt(); | ||
258 | } | ||
259 | pil = (real_irq & 0xf); | ||
260 | irq = irq_alloc(real_irq, pil); | ||
261 | |||
262 | if (irq == 0) | ||
263 | goto out; | ||
264 | |||
265 | handler_data = irq_get_handler_data(irq); | ||
266 | if (unlikely(handler_data)) | ||
267 | goto out; | ||
268 | |||
269 | handler_data = kzalloc(sizeof(struct sun4m_handler_data), GFP_ATOMIC); | ||
270 | if (unlikely(!handler_data)) { | ||
271 | prom_printf("IRQ: kzalloc(sun4m_handler_data) failed.\n"); | ||
272 | prom_halt(); | ||
273 | } | ||
274 | |||
275 | handler_data->mask = sun4m_imask[real_irq]; | ||
276 | handler_data->percpu = real_irq < OBP_INT_LEVEL_ONBOARD; | ||
277 | irq_set_chip_and_handler_name(irq, &sun4m_irq, | ||
278 | handle_level_irq, "level"); | ||
279 | irq_set_handler_data(irq, handler_data); | ||
280 | |||
281 | out: | ||
282 | return irq; | ||
269 | } | 283 | } |
270 | 284 | ||
271 | #ifdef CONFIG_SMP | 285 | #ifdef CONFIG_SMP |
272 | static void sun4m_send_ipi(int cpu, int level) | 286 | static void sun4m_send_ipi(int cpu, int level) |
273 | { | 287 | { |
274 | unsigned long mask = sun4m_get_irqmask(level); | 288 | sbus_writel(SUN4M_SOFT_INT(level), &sun4m_irq_percpu[cpu]->set); |
275 | |||
276 | sbus_writel(mask, &sun4m_irq_percpu[cpu]->set); | ||
277 | } | 289 | } |
278 | 290 | ||
279 | static void sun4m_clear_ipi(int cpu, int level) | 291 | static void sun4m_clear_ipi(int cpu, int level) |
280 | { | 292 | { |
281 | unsigned long mask = sun4m_get_irqmask(level); | 293 | sbus_writel(SUN4M_SOFT_INT(level), &sun4m_irq_percpu[cpu]->clear); |
282 | |||
283 | sbus_writel(mask, &sun4m_irq_percpu[cpu]->clear); | ||
284 | } | 294 | } |
285 | 295 | ||
286 | static void sun4m_set_udt(int cpu) | 296 | static void sun4m_set_udt(int cpu) |
@@ -343,7 +353,15 @@ void sun4m_nmi(struct pt_regs *regs) | |||
343 | prom_halt(); | 353 | prom_halt(); |
344 | } | 354 | } |
345 | 355 | ||
346 | /* Exported for sun4m_smp.c */ | 356 | void sun4m_unmask_profile_irq(void) |
357 | { | ||
358 | unsigned long flags; | ||
359 | |||
360 | local_irq_save(flags); | ||
361 | sbus_writel(sun4m_imask[SUN4M_PROFILE_IRQ], &sun4m_irq_global->mask_clear); | ||
362 | local_irq_restore(flags); | ||
363 | } | ||
364 | |||
347 | void sun4m_clear_profile_irq(int cpu) | 365 | void sun4m_clear_profile_irq(int cpu) |
348 | { | 366 | { |
349 | sbus_readl(&timers_percpu[cpu]->l14_limit); | 367 | sbus_readl(&timers_percpu[cpu]->l14_limit); |
@@ -358,6 +376,7 @@ static void __init sun4m_init_timers(irq_handler_t counter_fn) | |||
358 | { | 376 | { |
359 | struct device_node *dp = of_find_node_by_name(NULL, "counter"); | 377 | struct device_node *dp = of_find_node_by_name(NULL, "counter"); |
360 | int i, err, len, num_cpu_timers; | 378 | int i, err, len, num_cpu_timers; |
379 | unsigned int irq; | ||
361 | const u32 *addr; | 380 | const u32 *addr; |
362 | 381 | ||
363 | if (!dp) { | 382 | if (!dp) { |
@@ -384,8 +403,9 @@ static void __init sun4m_init_timers(irq_handler_t counter_fn) | |||
384 | 403 | ||
385 | master_l10_counter = &timers_global->l10_count; | 404 | master_l10_counter = &timers_global->l10_count; |
386 | 405 | ||
387 | err = request_irq(SUN4M_TIMER_IRQ, counter_fn, | 406 | irq = sun4m_build_device_irq(NULL, SUN4M_TIMER_IRQ); |
388 | (IRQF_DISABLED | SA_STATIC_ALLOC), "timer", NULL); | 407 | |
408 | err = request_irq(irq, counter_fn, IRQF_TIMER, "timer", NULL); | ||
389 | if (err) { | 409 | if (err) { |
390 | printk(KERN_ERR "sun4m_init_timers: Register IRQ error %d.\n", | 410 | printk(KERN_ERR "sun4m_init_timers: Register IRQ error %d.\n", |
391 | err); | 411 | err); |
@@ -452,14 +472,11 @@ void __init sun4m_init_IRQ(void) | |||
452 | if (num_cpu_iregs == 4) | 472 | if (num_cpu_iregs == 4) |
453 | sbus_writel(0, &sun4m_irq_global->interrupt_target); | 473 | sbus_writel(0, &sun4m_irq_global->interrupt_target); |
454 | 474 | ||
455 | BTFIXUPSET_CALL(enable_irq, sun4m_enable_irq, BTFIXUPCALL_NORM); | ||
456 | BTFIXUPSET_CALL(disable_irq, sun4m_disable_irq, BTFIXUPCALL_NORM); | ||
457 | BTFIXUPSET_CALL(enable_pil_irq, sun4m_enable_pil_irq, BTFIXUPCALL_NORM); | ||
458 | BTFIXUPSET_CALL(disable_pil_irq, sun4m_disable_pil_irq, BTFIXUPCALL_NORM); | ||
459 | BTFIXUPSET_CALL(clear_clock_irq, sun4m_clear_clock_irq, BTFIXUPCALL_NORM); | 475 | BTFIXUPSET_CALL(clear_clock_irq, sun4m_clear_clock_irq, BTFIXUPCALL_NORM); |
460 | BTFIXUPSET_CALL(load_profile_irq, sun4m_load_profile_irq, BTFIXUPCALL_NORM); | 476 | BTFIXUPSET_CALL(load_profile_irq, sun4m_load_profile_irq, BTFIXUPCALL_NORM); |
461 | 477 | ||
462 | sparc_irq_config.init_timers = sun4m_init_timers; | 478 | sparc_irq_config.init_timers = sun4m_init_timers; |
479 | sparc_irq_config.build_device_irq = sun4m_build_device_irq; | ||
463 | 480 | ||
464 | #ifdef CONFIG_SMP | 481 | #ifdef CONFIG_SMP |
465 | BTFIXUPSET_CALL(set_cpu_int, sun4m_send_ipi, BTFIXUPCALL_NORM); | 482 | BTFIXUPSET_CALL(set_cpu_int, sun4m_send_ipi, BTFIXUPCALL_NORM); |
diff --git a/arch/sparc/kernel/sun4m_smp.c b/arch/sparc/kernel/sun4m_smp.c index 5cc7dc51de3d..594768686525 100644 --- a/arch/sparc/kernel/sun4m_smp.c +++ b/arch/sparc/kernel/sun4m_smp.c | |||
@@ -15,6 +15,9 @@ | |||
15 | #include "irq.h" | 15 | #include "irq.h" |
16 | #include "kernel.h" | 16 | #include "kernel.h" |
17 | 17 | ||
18 | #define IRQ_IPI_SINGLE 12 | ||
19 | #define IRQ_IPI_MASK 13 | ||
20 | #define IRQ_IPI_RESCHED 14 | ||
18 | #define IRQ_CROSS_CALL 15 | 21 | #define IRQ_CROSS_CALL 15 |
19 | 22 | ||
20 | static inline unsigned long | 23 | static inline unsigned long |
@@ -26,6 +29,7 @@ swap_ulong(volatile unsigned long *ptr, unsigned long val) | |||
26 | return val; | 29 | return val; |
27 | } | 30 | } |
28 | 31 | ||
32 | static void smp4m_ipi_init(void); | ||
29 | static void smp_setup_percpu_timer(void); | 33 | static void smp_setup_percpu_timer(void); |
30 | 34 | ||
31 | void __cpuinit smp4m_callin(void) | 35 | void __cpuinit smp4m_callin(void) |
@@ -59,8 +63,6 @@ void __cpuinit smp4m_callin(void) | |||
59 | local_flush_cache_all(); | 63 | local_flush_cache_all(); |
60 | local_flush_tlb_all(); | 64 | local_flush_tlb_all(); |
61 | 65 | ||
62 | cpu_probe(); | ||
63 | |||
64 | /* Fix idle thread fields. */ | 66 | /* Fix idle thread fields. */ |
65 | __asm__ __volatile__("ld [%0], %%g6\n\t" | 67 | __asm__ __volatile__("ld [%0], %%g6\n\t" |
66 | : : "r" (¤t_set[cpuid]) | 68 | : : "r" (¤t_set[cpuid]) |
@@ -70,7 +72,7 @@ void __cpuinit smp4m_callin(void) | |||
70 | atomic_inc(&init_mm.mm_count); | 72 | atomic_inc(&init_mm.mm_count); |
71 | current->active_mm = &init_mm; | 73 | current->active_mm = &init_mm; |
72 | 74 | ||
73 | while (!cpu_isset(cpuid, smp_commenced_mask)) | 75 | while (!cpumask_test_cpu(cpuid, &smp_commenced_mask)) |
74 | mb(); | 76 | mb(); |
75 | 77 | ||
76 | local_irq_enable(); | 78 | local_irq_enable(); |
@@ -83,6 +85,7 @@ void __cpuinit smp4m_callin(void) | |||
83 | */ | 85 | */ |
84 | void __init smp4m_boot_cpus(void) | 86 | void __init smp4m_boot_cpus(void) |
85 | { | 87 | { |
88 | smp4m_ipi_init(); | ||
86 | smp_setup_percpu_timer(); | 89 | smp_setup_percpu_timer(); |
87 | local_flush_cache_all(); | 90 | local_flush_cache_all(); |
88 | } | 91 | } |
@@ -150,18 +153,25 @@ void __init smp4m_smp_done(void) | |||
150 | /* Ok, they are spinning and ready to go. */ | 153 | /* Ok, they are spinning and ready to go. */ |
151 | } | 154 | } |
152 | 155 | ||
153 | /* At each hardware IRQ, we get this called to forward IRQ reception | 156 | |
154 | * to the next processor. The caller must disable the IRQ level being | 157 | /* Initialize IPIs on the SUN4M SMP machine */ |
155 | * serviced globally so that there are no double interrupts received. | 158 | static void __init smp4m_ipi_init(void) |
156 | * | 159 | { |
157 | * XXX See sparc64 irq.c. | 160 | } |
158 | */ | 161 | |
159 | void smp4m_irq_rotate(int cpu) | 162 | static void smp4m_ipi_resched(int cpu) |
163 | { | ||
164 | set_cpu_int(cpu, IRQ_IPI_RESCHED); | ||
165 | } | ||
166 | |||
167 | static void smp4m_ipi_single(int cpu) | ||
160 | { | 168 | { |
161 | int next = cpu_data(cpu).next; | 169 | set_cpu_int(cpu, IRQ_IPI_SINGLE); |
170 | } | ||
162 | 171 | ||
163 | if (next != cpu) | 172 | static void smp4m_ipi_mask_one(int cpu) |
164 | set_irq_udt(next); | 173 | { |
174 | set_cpu_int(cpu, IRQ_IPI_MASK); | ||
165 | } | 175 | } |
166 | 176 | ||
167 | static struct smp_funcall { | 177 | static struct smp_funcall { |
@@ -199,10 +209,10 @@ static void smp4m_cross_call(smpfunc_t func, cpumask_t mask, unsigned long arg1, | |||
199 | { | 209 | { |
200 | register int i; | 210 | register int i; |
201 | 211 | ||
202 | cpu_clear(smp_processor_id(), mask); | 212 | cpumask_clear_cpu(smp_processor_id(), &mask); |
203 | cpus_and(mask, cpu_online_map, mask); | 213 | cpumask_and(&mask, cpu_online_mask, &mask); |
204 | for (i = 0; i < ncpus; i++) { | 214 | for (i = 0; i < ncpus; i++) { |
205 | if (cpu_isset(i, mask)) { | 215 | if (cpumask_test_cpu(i, &mask)) { |
206 | ccall_info.processors_in[i] = 0; | 216 | ccall_info.processors_in[i] = 0; |
207 | ccall_info.processors_out[i] = 0; | 217 | ccall_info.processors_out[i] = 0; |
208 | set_cpu_int(i, IRQ_CROSS_CALL); | 218 | set_cpu_int(i, IRQ_CROSS_CALL); |
@@ -218,7 +228,7 @@ static void smp4m_cross_call(smpfunc_t func, cpumask_t mask, unsigned long arg1, | |||
218 | 228 | ||
219 | i = 0; | 229 | i = 0; |
220 | do { | 230 | do { |
221 | if (!cpu_isset(i, mask)) | 231 | if (!cpumask_test_cpu(i, &mask)) |
222 | continue; | 232 | continue; |
223 | while (!ccall_info.processors_in[i]) | 233 | while (!ccall_info.processors_in[i]) |
224 | barrier(); | 234 | barrier(); |
@@ -226,7 +236,7 @@ static void smp4m_cross_call(smpfunc_t func, cpumask_t mask, unsigned long arg1, | |||
226 | 236 | ||
227 | i = 0; | 237 | i = 0; |
228 | do { | 238 | do { |
229 | if (!cpu_isset(i, mask)) | 239 | if (!cpumask_test_cpu(i, &mask)) |
230 | continue; | 240 | continue; |
231 | while (!ccall_info.processors_out[i]) | 241 | while (!ccall_info.processors_out[i]) |
232 | barrier(); | 242 | barrier(); |
@@ -277,7 +287,7 @@ static void __cpuinit smp_setup_percpu_timer(void) | |||
277 | load_profile_irq(cpu, lvl14_resolution); | 287 | load_profile_irq(cpu, lvl14_resolution); |
278 | 288 | ||
279 | if (cpu == boot_cpu_id) | 289 | if (cpu == boot_cpu_id) |
280 | enable_pil_irq(14); | 290 | sun4m_unmask_profile_irq(); |
281 | } | 291 | } |
282 | 292 | ||
283 | static void __init smp4m_blackbox_id(unsigned *addr) | 293 | static void __init smp4m_blackbox_id(unsigned *addr) |
@@ -306,4 +316,7 @@ void __init sun4m_init_smp(void) | |||
306 | BTFIXUPSET_BLACKBOX(load_current, smp4m_blackbox_current); | 316 | BTFIXUPSET_BLACKBOX(load_current, smp4m_blackbox_current); |
307 | BTFIXUPSET_CALL(smp_cross_call, smp4m_cross_call, BTFIXUPCALL_NORM); | 317 | BTFIXUPSET_CALL(smp_cross_call, smp4m_cross_call, BTFIXUPCALL_NORM); |
308 | BTFIXUPSET_CALL(__hard_smp_processor_id, __smp4m_processor_id, BTFIXUPCALL_NORM); | 318 | BTFIXUPSET_CALL(__hard_smp_processor_id, __smp4m_processor_id, BTFIXUPCALL_NORM); |
319 | BTFIXUPSET_CALL(smp_ipi_resched, smp4m_ipi_resched, BTFIXUPCALL_NORM); | ||
320 | BTFIXUPSET_CALL(smp_ipi_single, smp4m_ipi_single, BTFIXUPCALL_NORM); | ||
321 | BTFIXUPSET_CALL(smp_ipi_mask_one, smp4m_ipi_mask_one, BTFIXUPCALL_NORM); | ||
309 | } | 322 | } |
diff --git a/arch/sparc/kernel/sysfs.c b/arch/sparc/kernel/sysfs.c index 1eb8b00aed75..7408201d7efb 100644 --- a/arch/sparc/kernel/sysfs.c +++ b/arch/sparc/kernel/sysfs.c | |||
@@ -103,9 +103,10 @@ static unsigned long run_on_cpu(unsigned long cpu, | |||
103 | unsigned long (*func)(unsigned long), | 103 | unsigned long (*func)(unsigned long), |
104 | unsigned long arg) | 104 | unsigned long arg) |
105 | { | 105 | { |
106 | cpumask_t old_affinity = current->cpus_allowed; | 106 | cpumask_t old_affinity; |
107 | unsigned long ret; | 107 | unsigned long ret; |
108 | 108 | ||
109 | cpumask_copy(&old_affinity, tsk_cpus_allowed(current)); | ||
109 | /* should return -EINVAL to userspace */ | 110 | /* should return -EINVAL to userspace */ |
110 | if (set_cpus_allowed_ptr(current, cpumask_of(cpu))) | 111 | if (set_cpus_allowed_ptr(current, cpumask_of(cpu))) |
111 | return 0; | 112 | return 0; |
diff --git a/arch/sparc/kernel/time_32.c b/arch/sparc/kernel/time_32.c index 96046a4024c2..1060e0672a4b 100644 --- a/arch/sparc/kernel/time_32.c +++ b/arch/sparc/kernel/time_32.c | |||
@@ -228,14 +228,10 @@ static void __init sbus_time_init(void) | |||
228 | 228 | ||
229 | void __init time_init(void) | 229 | void __init time_init(void) |
230 | { | 230 | { |
231 | #ifdef CONFIG_PCI | 231 | if (pcic_present()) |
232 | extern void pci_time_init(void); | ||
233 | if (pcic_present()) { | ||
234 | pci_time_init(); | 232 | pci_time_init(); |
235 | return; | 233 | else |
236 | } | 234 | sbus_time_init(); |
237 | #endif | ||
238 | sbus_time_init(); | ||
239 | } | 235 | } |
240 | 236 | ||
241 | 237 | ||
diff --git a/arch/sparc/kernel/us2e_cpufreq.c b/arch/sparc/kernel/us2e_cpufreq.c index 8f982b76c712..531d54fc9829 100644 --- a/arch/sparc/kernel/us2e_cpufreq.c +++ b/arch/sparc/kernel/us2e_cpufreq.c | |||
@@ -237,7 +237,7 @@ static unsigned int us2e_freq_get(unsigned int cpu) | |||
237 | if (!cpu_online(cpu)) | 237 | if (!cpu_online(cpu)) |
238 | return 0; | 238 | return 0; |
239 | 239 | ||
240 | cpus_allowed = current->cpus_allowed; | 240 | cpumask_copy(&cpus_allowed, tsk_cpus_allowed(current)); |
241 | set_cpus_allowed_ptr(current, cpumask_of(cpu)); | 241 | set_cpus_allowed_ptr(current, cpumask_of(cpu)); |
242 | 242 | ||
243 | clock_tick = sparc64_get_clock_tick(cpu) / 1000; | 243 | clock_tick = sparc64_get_clock_tick(cpu) / 1000; |
@@ -258,7 +258,7 @@ static void us2e_set_cpu_divider_index(unsigned int cpu, unsigned int index) | |||
258 | if (!cpu_online(cpu)) | 258 | if (!cpu_online(cpu)) |
259 | return; | 259 | return; |
260 | 260 | ||
261 | cpus_allowed = current->cpus_allowed; | 261 | cpumask_copy(&cpus_allowed, tsk_cpus_allowed(current)); |
262 | set_cpus_allowed_ptr(current, cpumask_of(cpu)); | 262 | set_cpus_allowed_ptr(current, cpumask_of(cpu)); |
263 | 263 | ||
264 | new_freq = clock_tick = sparc64_get_clock_tick(cpu) / 1000; | 264 | new_freq = clock_tick = sparc64_get_clock_tick(cpu) / 1000; |
diff --git a/arch/sparc/kernel/us3_cpufreq.c b/arch/sparc/kernel/us3_cpufreq.c index f35d1e794548..9a8ceb700833 100644 --- a/arch/sparc/kernel/us3_cpufreq.c +++ b/arch/sparc/kernel/us3_cpufreq.c | |||
@@ -85,7 +85,7 @@ static unsigned int us3_freq_get(unsigned int cpu) | |||
85 | if (!cpu_online(cpu)) | 85 | if (!cpu_online(cpu)) |
86 | return 0; | 86 | return 0; |
87 | 87 | ||
88 | cpus_allowed = current->cpus_allowed; | 88 | cpumask_copy(&cpus_allowed, tsk_cpus_allowed(current)); |
89 | set_cpus_allowed_ptr(current, cpumask_of(cpu)); | 89 | set_cpus_allowed_ptr(current, cpumask_of(cpu)); |
90 | 90 | ||
91 | reg = read_safari_cfg(); | 91 | reg = read_safari_cfg(); |
@@ -105,7 +105,7 @@ static void us3_set_cpu_divider_index(unsigned int cpu, unsigned int index) | |||
105 | if (!cpu_online(cpu)) | 105 | if (!cpu_online(cpu)) |
106 | return; | 106 | return; |
107 | 107 | ||
108 | cpus_allowed = current->cpus_allowed; | 108 | cpumask_copy(&cpus_allowed, tsk_cpus_allowed(current)); |
109 | set_cpus_allowed_ptr(current, cpumask_of(cpu)); | 109 | set_cpus_allowed_ptr(current, cpumask_of(cpu)); |
110 | 110 | ||
111 | new_freq = sparc64_get_clock_tick(cpu) / 1000; | 111 | new_freq = sparc64_get_clock_tick(cpu) / 1000; |
diff --git a/arch/sparc/lib/Makefile b/arch/sparc/lib/Makefile index 846d1c4374ea..7f01b8fce8bc 100644 --- a/arch/sparc/lib/Makefile +++ b/arch/sparc/lib/Makefile | |||
@@ -15,7 +15,6 @@ lib-$(CONFIG_SPARC32) += divdi3.o udivdi3.o | |||
15 | lib-$(CONFIG_SPARC32) += copy_user.o locks.o | 15 | lib-$(CONFIG_SPARC32) += copy_user.o locks.o |
16 | lib-y += atomic_$(BITS).o | 16 | lib-y += atomic_$(BITS).o |
17 | lib-$(CONFIG_SPARC32) += lshrdi3.o ashldi3.o | 17 | lib-$(CONFIG_SPARC32) += lshrdi3.o ashldi3.o |
18 | lib-$(CONFIG_SPARC32) += rwsem_32.o | ||
19 | lib-$(CONFIG_SPARC32) += muldi3.o bitext.o cmpdi2.o | 18 | lib-$(CONFIG_SPARC32) += muldi3.o bitext.o cmpdi2.o |
20 | 19 | ||
21 | lib-$(CONFIG_SPARC64) += copy_page.o clear_page.o bzero.o | 20 | lib-$(CONFIG_SPARC64) += copy_page.o clear_page.o bzero.o |
diff --git a/arch/sparc/lib/rwsem_32.S b/arch/sparc/lib/rwsem_32.S deleted file mode 100644 index 9675268e7fde..000000000000 --- a/arch/sparc/lib/rwsem_32.S +++ /dev/null | |||
@@ -1,204 +0,0 @@ | |||
1 | /* | ||
2 | * Assembly part of rw semaphores. | ||
3 | * | ||
4 | * Copyright (C) 1999 Jakub Jelinek (jakub@redhat.com) | ||
5 | */ | ||
6 | |||
7 | #include <asm/ptrace.h> | ||
8 | #include <asm/psr.h> | ||
9 | |||
10 | .section .sched.text, "ax" | ||
11 | .align 4 | ||
12 | |||
13 | .globl ___down_read | ||
14 | ___down_read: | ||
15 | rd %psr, %g3 | ||
16 | nop | ||
17 | nop | ||
18 | nop | ||
19 | or %g3, PSR_PIL, %g7 | ||
20 | wr %g7, 0, %psr | ||
21 | nop | ||
22 | nop | ||
23 | nop | ||
24 | #ifdef CONFIG_SMP | ||
25 | 1: ldstub [%g1 + 4], %g7 | ||
26 | tst %g7 | ||
27 | bne 1b | ||
28 | ld [%g1], %g7 | ||
29 | sub %g7, 1, %g7 | ||
30 | st %g7, [%g1] | ||
31 | stb %g0, [%g1 + 4] | ||
32 | #else | ||
33 | ld [%g1], %g7 | ||
34 | sub %g7, 1, %g7 | ||
35 | st %g7, [%g1] | ||
36 | #endif | ||
37 | wr %g3, 0, %psr | ||
38 | add %g7, 1, %g7 | ||
39 | nop | ||
40 | nop | ||
41 | subcc %g7, 1, %g7 | ||
42 | bneg 3f | ||
43 | nop | ||
44 | 2: jmpl %o7, %g0 | ||
45 | mov %g4, %o7 | ||
46 | 3: save %sp, -64, %sp | ||
47 | mov %g1, %l1 | ||
48 | mov %g4, %l4 | ||
49 | bcs 4f | ||
50 | mov %g5, %l5 | ||
51 | call down_read_failed | ||
52 | mov %l1, %o0 | ||
53 | mov %l1, %g1 | ||
54 | mov %l4, %g4 | ||
55 | ba ___down_read | ||
56 | restore %l5, %g0, %g5 | ||
57 | 4: call down_read_failed_biased | ||
58 | mov %l1, %o0 | ||
59 | mov %l1, %g1 | ||
60 | mov %l4, %g4 | ||
61 | ba 2b | ||
62 | restore %l5, %g0, %g5 | ||
63 | |||
64 | .globl ___down_write | ||
65 | ___down_write: | ||
66 | rd %psr, %g3 | ||
67 | nop | ||
68 | nop | ||
69 | nop | ||
70 | or %g3, PSR_PIL, %g7 | ||
71 | wr %g7, 0, %psr | ||
72 | sethi %hi(0x01000000), %g2 | ||
73 | nop | ||
74 | nop | ||
75 | #ifdef CONFIG_SMP | ||
76 | 1: ldstub [%g1 + 4], %g7 | ||
77 | tst %g7 | ||
78 | bne 1b | ||
79 | ld [%g1], %g7 | ||
80 | sub %g7, %g2, %g7 | ||
81 | st %g7, [%g1] | ||
82 | stb %g0, [%g1 + 4] | ||
83 | #else | ||
84 | ld [%g1], %g7 | ||
85 | sub %g7, %g2, %g7 | ||
86 | st %g7, [%g1] | ||
87 | #endif | ||
88 | wr %g3, 0, %psr | ||
89 | add %g7, %g2, %g7 | ||
90 | nop | ||
91 | nop | ||
92 | subcc %g7, %g2, %g7 | ||
93 | bne 3f | ||
94 | nop | ||
95 | 2: jmpl %o7, %g0 | ||
96 | mov %g4, %o7 | ||
97 | 3: save %sp, -64, %sp | ||
98 | mov %g1, %l1 | ||
99 | mov %g4, %l4 | ||
100 | bcs 4f | ||
101 | mov %g5, %l5 | ||
102 | call down_write_failed | ||
103 | mov %l1, %o0 | ||
104 | mov %l1, %g1 | ||
105 | mov %l4, %g4 | ||
106 | ba ___down_write | ||
107 | restore %l5, %g0, %g5 | ||
108 | 4: call down_write_failed_biased | ||
109 | mov %l1, %o0 | ||
110 | mov %l1, %g1 | ||
111 | mov %l4, %g4 | ||
112 | ba 2b | ||
113 | restore %l5, %g0, %g5 | ||
114 | |||
115 | .text | ||
116 | .globl ___up_read | ||
117 | ___up_read: | ||
118 | rd %psr, %g3 | ||
119 | nop | ||
120 | nop | ||
121 | nop | ||
122 | or %g3, PSR_PIL, %g7 | ||
123 | wr %g7, 0, %psr | ||
124 | nop | ||
125 | nop | ||
126 | nop | ||
127 | #ifdef CONFIG_SMP | ||
128 | 1: ldstub [%g1 + 4], %g7 | ||
129 | tst %g7 | ||
130 | bne 1b | ||
131 | ld [%g1], %g7 | ||
132 | add %g7, 1, %g7 | ||
133 | st %g7, [%g1] | ||
134 | stb %g0, [%g1 + 4] | ||
135 | #else | ||
136 | ld [%g1], %g7 | ||
137 | add %g7, 1, %g7 | ||
138 | st %g7, [%g1] | ||
139 | #endif | ||
140 | wr %g3, 0, %psr | ||
141 | nop | ||
142 | nop | ||
143 | nop | ||
144 | cmp %g7, 0 | ||
145 | be 3f | ||
146 | nop | ||
147 | 2: jmpl %o7, %g0 | ||
148 | mov %g4, %o7 | ||
149 | 3: save %sp, -64, %sp | ||
150 | mov %g1, %l1 | ||
151 | mov %g4, %l4 | ||
152 | mov %g5, %l5 | ||
153 | clr %o1 | ||
154 | call __rwsem_wake | ||
155 | mov %l1, %o0 | ||
156 | mov %l1, %g1 | ||
157 | mov %l4, %g4 | ||
158 | ba 2b | ||
159 | restore %l5, %g0, %g5 | ||
160 | |||
161 | .globl ___up_write | ||
162 | ___up_write: | ||
163 | rd %psr, %g3 | ||
164 | nop | ||
165 | nop | ||
166 | nop | ||
167 | or %g3, PSR_PIL, %g7 | ||
168 | wr %g7, 0, %psr | ||
169 | sethi %hi(0x01000000), %g2 | ||
170 | nop | ||
171 | nop | ||
172 | #ifdef CONFIG_SMP | ||
173 | 1: ldstub [%g1 + 4], %g7 | ||
174 | tst %g7 | ||
175 | bne 1b | ||
176 | ld [%g1], %g7 | ||
177 | add %g7, %g2, %g7 | ||
178 | st %g7, [%g1] | ||
179 | stb %g0, [%g1 + 4] | ||
180 | #else | ||
181 | ld [%g1], %g7 | ||
182 | add %g7, %g2, %g7 | ||
183 | st %g7, [%g1] | ||
184 | #endif | ||
185 | wr %g3, 0, %psr | ||
186 | sub %g7, %g2, %g7 | ||
187 | nop | ||
188 | nop | ||
189 | addcc %g7, %g2, %g7 | ||
190 | bcs 3f | ||
191 | nop | ||
192 | 2: jmpl %o7, %g0 | ||
193 | mov %g4, %o7 | ||
194 | 3: save %sp, -64, %sp | ||
195 | mov %g1, %l1 | ||
196 | mov %g4, %l4 | ||
197 | mov %g5, %l5 | ||
198 | mov %g7, %o1 | ||
199 | call __rwsem_wake | ||
200 | mov %l1, %o0 | ||
201 | mov %l1, %g1 | ||
202 | mov %l4, %g4 | ||
203 | ba 2b | ||
204 | restore %l5, %g0, %g5 | ||
diff --git a/arch/sparc/mm/init_64.c b/arch/sparc/mm/init_64.c index 2f6ae1d1fb6b..e10cd03fab80 100644 --- a/arch/sparc/mm/init_64.c +++ b/arch/sparc/mm/init_64.c | |||
@@ -862,7 +862,7 @@ static void init_node_masks_nonnuma(void) | |||
862 | for (i = 0; i < NR_CPUS; i++) | 862 | for (i = 0; i < NR_CPUS; i++) |
863 | numa_cpu_lookup_table[i] = 0; | 863 | numa_cpu_lookup_table[i] = 0; |
864 | 864 | ||
865 | numa_cpumask_lookup_table[0] = CPU_MASK_ALL; | 865 | cpumask_setall(&numa_cpumask_lookup_table[0]); |
866 | } | 866 | } |
867 | 867 | ||
868 | #ifdef CONFIG_NEED_MULTIPLE_NODES | 868 | #ifdef CONFIG_NEED_MULTIPLE_NODES |
@@ -1080,7 +1080,7 @@ static void __init numa_parse_mdesc_group_cpus(struct mdesc_handle *md, | |||
1080 | { | 1080 | { |
1081 | u64 arc; | 1081 | u64 arc; |
1082 | 1082 | ||
1083 | cpus_clear(*mask); | 1083 | cpumask_clear(mask); |
1084 | 1084 | ||
1085 | mdesc_for_each_arc(arc, md, grp, MDESC_ARC_TYPE_BACK) { | 1085 | mdesc_for_each_arc(arc, md, grp, MDESC_ARC_TYPE_BACK) { |
1086 | u64 target = mdesc_arc_target(md, arc); | 1086 | u64 target = mdesc_arc_target(md, arc); |
@@ -1091,7 +1091,7 @@ static void __init numa_parse_mdesc_group_cpus(struct mdesc_handle *md, | |||
1091 | continue; | 1091 | continue; |
1092 | id = mdesc_get_property(md, target, "id", NULL); | 1092 | id = mdesc_get_property(md, target, "id", NULL); |
1093 | if (*id < nr_cpu_ids) | 1093 | if (*id < nr_cpu_ids) |
1094 | cpu_set(*id, *mask); | 1094 | cpumask_set_cpu(*id, mask); |
1095 | } | 1095 | } |
1096 | } | 1096 | } |
1097 | 1097 | ||
@@ -1153,13 +1153,13 @@ static int __init numa_parse_mdesc_group(struct mdesc_handle *md, u64 grp, | |||
1153 | 1153 | ||
1154 | numa_parse_mdesc_group_cpus(md, grp, &mask); | 1154 | numa_parse_mdesc_group_cpus(md, grp, &mask); |
1155 | 1155 | ||
1156 | for_each_cpu_mask(cpu, mask) | 1156 | for_each_cpu(cpu, &mask) |
1157 | numa_cpu_lookup_table[cpu] = index; | 1157 | numa_cpu_lookup_table[cpu] = index; |
1158 | numa_cpumask_lookup_table[index] = mask; | 1158 | cpumask_copy(&numa_cpumask_lookup_table[index], &mask); |
1159 | 1159 | ||
1160 | if (numa_debug) { | 1160 | if (numa_debug) { |
1161 | printk(KERN_INFO "NUMA GROUP[%d]: cpus [ ", index); | 1161 | printk(KERN_INFO "NUMA GROUP[%d]: cpus [ ", index); |
1162 | for_each_cpu_mask(cpu, mask) | 1162 | for_each_cpu(cpu, &mask) |
1163 | printk("%d ", cpu); | 1163 | printk("%d ", cpu); |
1164 | printk("]\n"); | 1164 | printk("]\n"); |
1165 | } | 1165 | } |
@@ -1218,7 +1218,7 @@ static int __init numa_parse_jbus(void) | |||
1218 | index = 0; | 1218 | index = 0; |
1219 | for_each_present_cpu(cpu) { | 1219 | for_each_present_cpu(cpu) { |
1220 | numa_cpu_lookup_table[cpu] = index; | 1220 | numa_cpu_lookup_table[cpu] = index; |
1221 | numa_cpumask_lookup_table[index] = cpumask_of_cpu(cpu); | 1221 | cpumask_copy(&numa_cpumask_lookup_table[index], cpumask_of(cpu)); |
1222 | node_masks[index].mask = ~((1UL << 36UL) - 1UL); | 1222 | node_masks[index].mask = ~((1UL << 36UL) - 1UL); |
1223 | node_masks[index].val = cpu << 36UL; | 1223 | node_masks[index].val = cpu << 36UL; |
1224 | 1224 | ||