1 /*
2  *  Derived from arch/i386/kernel/irq.c
3  *    Copyright (C) 1992 Linus Torvalds
4  *  Adapted from arch/i386 by Gary Thomas
5  *    Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org)
6  *  Updated and modified by Cort Dougan <cort@fsmlabs.com>
7  *    Copyright (C) 1996-2001 Cort Dougan
8  *  Adapted for Power Macintosh by Paul Mackerras
9  *    Copyright (C) 1996 Paul Mackerras (paulus@cs.anu.edu.au)
10  *
11  * This program is free software; you can redistribute it and/or
12  * modify it under the terms of the GNU General Public License
13  * as published by the Free Software Foundation; either version
14  * 2 of the License, or (at your option) any later version.
15  *
16  * This file contains the code used by various IRQ handling routines:
17  * asking for different IRQ's should be done through these routines
18  * instead of just grabbing them. Thus setups with different IRQ numbers
19  * shouldn't result in any weird surprises, and installing new handlers
20  * should be easier.
21  *
22  * The MPC8xx has an interrupt mask in the SIU.  If a bit is set, the
23  * interrupt is _enabled_.  As expected, IRQ0 is bit 0 in the 32-bit
24  * mask register (of which only 16 are defined), hence the weird shifting
25  * and complement of the cached_irq_mask.  I want to be able to stuff
26  * this right into the SIU SMASK register.
27  * Many of the prep/chrp functions are conditional compiled on CONFIG_PPC_8xx
28  * to reduce code space and undefined function references.
29  */
30 
31 #undef DEBUG
32 
33 #include <linux/export.h>
34 #include <linux/threads.h>
35 #include <linux/kernel_stat.h>
36 #include <linux/signal.h>
37 #include <linux/sched.h>
38 #include <linux/ptrace.h>
39 #include <linux/ioport.h>
40 #include <linux/interrupt.h>
41 #include <linux/timex.h>
42 #include <linux/init.h>
43 #include <linux/slab.h>
44 #include <linux/delay.h>
45 #include <linux/irq.h>
46 #include <linux/seq_file.h>
47 #include <linux/cpumask.h>
48 #include <linux/profile.h>
49 #include <linux/bitops.h>
50 #include <linux/list.h>
51 #include <linux/radix-tree.h>
52 #include <linux/mutex.h>
53 #include <linux/pci.h>
54 #include <linux/debugfs.h>
55 #include <linux/of.h>
56 #include <linux/of_irq.h>
57 
58 #include <linux/uaccess.h>
59 #include <asm/io.h>
60 #include <asm/pgtable.h>
61 #include <asm/irq.h>
62 #include <asm/cache.h>
63 #include <asm/prom.h>
64 #include <asm/ptrace.h>
65 #include <asm/machdep.h>
66 #include <asm/udbg.h>
67 #include <asm/smp.h>
68 #include <asm/livepatch.h>
69 #include <asm/asm-prototypes.h>
70 #include <asm/hw_irq.h>
71 
72 #ifdef CONFIG_PPC64
73 #include <asm/paca.h>
74 #include <asm/firmware.h>
75 #include <asm/lv1call.h>
76 #endif
77 #define CREATE_TRACE_POINTS
78 #include <asm/trace.h>
79 #include <asm/cpu_has_feature.h>
80 
81 DEFINE_PER_CPU_SHARED_ALIGNED(irq_cpustat_t, irq_stat);
82 EXPORT_PER_CPU_SYMBOL(irq_stat);
83 
84 int __irq_offset_value;
85 
86 #ifdef CONFIG_PPC32
87 EXPORT_SYMBOL(__irq_offset_value);
88 atomic_t ppc_n_lost_interrupts;
89 
90 #ifdef CONFIG_TAU_INT
91 extern int tau_initialized;
92 u32 tau_interrupts(unsigned long cpu);
93 #endif
94 #endif /* CONFIG_PPC32 */
95 
96 #ifdef CONFIG_PPC64
97 
98 int distribute_irqs = 1;
99 
get_irq_happened(void)100 static inline notrace unsigned long get_irq_happened(void)
101 {
102 	unsigned long happened;
103 
104 	__asm__ __volatile__("lbz %0,%1(13)"
105 	: "=r" (happened) : "i" (offsetof(struct paca_struct, irq_happened)));
106 
107 	return happened;
108 }
109 
decrementer_check_overflow(void)110 static inline notrace int decrementer_check_overflow(void)
111 {
112  	u64 now = get_tb_or_rtc();
113 	u64 *next_tb = this_cpu_ptr(&decrementers_next_tb);
114 
115 	return now >= *next_tb;
116 }
117 
118 /* This is called whenever we are re-enabling interrupts
119  * and returns either 0 (nothing to do) or 500/900/280/a00/e80 if
120  * there's an EE, DEC or DBELL to generate.
121  *
122  * This is called in two contexts: From arch_local_irq_restore()
123  * before soft-enabling interrupts, and from the exception exit
124  * path when returning from an interrupt from a soft-disabled to
125  * a soft enabled context. In both case we have interrupts hard
126  * disabled.
127  *
128  * We take care of only clearing the bits we handled in the
129  * PACA irq_happened field since we can only re-emit one at a
130  * time and we don't want to "lose" one.
131  */
__check_irq_replay(void)132 notrace unsigned int __check_irq_replay(void)
133 {
134 	/*
135 	 * We use local_paca rather than get_paca() to avoid all
136 	 * the debug_smp_processor_id() business in this low level
137 	 * function
138 	 */
139 	unsigned char happened = local_paca->irq_happened;
140 
141 	/*
142 	 * We are responding to the next interrupt, so interrupt-off
143 	 * latencies should be reset here.
144 	 */
145 	trace_hardirqs_on();
146 	trace_hardirqs_off();
147 
148 	/*
149 	 * We are always hard disabled here, but PACA_IRQ_HARD_DIS may
150 	 * not be set, which means interrupts have only just been hard
151 	 * disabled as part of the local_irq_restore or interrupt return
152 	 * code. In that case, skip the decrementr check becaus it's
153 	 * expensive to read the TB.
154 	 *
155 	 * HARD_DIS then gets cleared here, but it's reconciled later.
156 	 * Either local_irq_disable will replay the interrupt and that
157 	 * will reconcile state like other hard interrupts. Or interrupt
158 	 * retur will replay the interrupt and in that case it sets
159 	 * PACA_IRQ_HARD_DIS by hand (see comments in entry_64.S).
160 	 */
161 	if (happened & PACA_IRQ_HARD_DIS) {
162 		local_paca->irq_happened &= ~PACA_IRQ_HARD_DIS;
163 
164 		/*
165 		 * We may have missed a decrementer interrupt if hard disabled.
166 		 * Check the decrementer register in case we had a rollover
167 		 * while hard disabled.
168 		 */
169 		if (!(happened & PACA_IRQ_DEC)) {
170 			if (decrementer_check_overflow()) {
171 				local_paca->irq_happened |= PACA_IRQ_DEC;
172 				happened |= PACA_IRQ_DEC;
173 			}
174 		}
175 	}
176 
177 	/*
178 	 * Force the delivery of pending soft-disabled interrupts on PS3.
179 	 * Any HV call will have this side effect.
180 	 */
181 	if (firmware_has_feature(FW_FEATURE_PS3_LV1)) {
182 		u64 tmp, tmp2;
183 		lv1_get_version_info(&tmp, &tmp2);
184 	}
185 
186 	/*
187 	 * Check if an hypervisor Maintenance interrupt happened.
188 	 * This is a higher priority interrupt than the others, so
189 	 * replay it first.
190 	 */
191 	if (happened & PACA_IRQ_HMI) {
192 		local_paca->irq_happened &= ~PACA_IRQ_HMI;
193 		return 0xe60;
194 	}
195 
196 	if (happened & PACA_IRQ_DEC) {
197 		local_paca->irq_happened &= ~PACA_IRQ_DEC;
198 		return 0x900;
199 	}
200 
201 	if (happened & PACA_IRQ_PMI) {
202 		local_paca->irq_happened &= ~PACA_IRQ_PMI;
203 		return 0xf00;
204 	}
205 
206 	if (happened & PACA_IRQ_EE) {
207 		local_paca->irq_happened &= ~PACA_IRQ_EE;
208 		return 0x500;
209 	}
210 
211 #ifdef CONFIG_PPC_BOOK3E
212 	/*
213 	 * Check if an EPR external interrupt happened this bit is typically
214 	 * set if we need to handle another "edge" interrupt from within the
215 	 * MPIC "EPR" handler.
216 	 */
217 	if (happened & PACA_IRQ_EE_EDGE) {
218 		local_paca->irq_happened &= ~PACA_IRQ_EE_EDGE;
219 		return 0x500;
220 	}
221 
222 	if (happened & PACA_IRQ_DBELL) {
223 		local_paca->irq_happened &= ~PACA_IRQ_DBELL;
224 		return 0x280;
225 	}
226 #else
227 	if (happened & PACA_IRQ_DBELL) {
228 		local_paca->irq_happened &= ~PACA_IRQ_DBELL;
229 		return 0xa00;
230 	}
231 #endif /* CONFIG_PPC_BOOK3E */
232 
233 	/* There should be nothing left ! */
234 	BUG_ON(local_paca->irq_happened != 0);
235 
236 	return 0;
237 }
238 
arch_local_irq_restore(unsigned long mask)239 notrace void arch_local_irq_restore(unsigned long mask)
240 {
241 	unsigned char irq_happened;
242 	unsigned int replay;
243 
244 	/* Write the new soft-enabled value */
245 	irq_soft_mask_set(mask);
246 	if (mask)
247 		return;
248 
249 	/*
250 	 * From this point onward, we can take interrupts, preempt,
251 	 * etc... unless we got hard-disabled. We check if an event
252 	 * happened. If none happened, we know we can just return.
253 	 *
254 	 * We may have preempted before the check below, in which case
255 	 * we are checking the "new" CPU instead of the old one. This
256 	 * is only a problem if an event happened on the "old" CPU.
257 	 *
258 	 * External interrupt events will have caused interrupts to
259 	 * be hard-disabled, so there is no problem, we
260 	 * cannot have preempted.
261 	 */
262 	irq_happened = get_irq_happened();
263 	if (!irq_happened) {
264 		/*
265 		 * FIXME. Here we'd like to be able to do:
266 		 *
267 		 * #ifdef CONFIG_PPC_IRQ_SOFT_MASK_DEBUG
268 		 *   WARN_ON(!(mfmsr() & MSR_EE));
269 		 * #endif
270 		 *
271 		 * But currently it hits in a few paths, we should fix those and
272 		 * enable the warning.
273 		 */
274 		return;
275 	}
276 
277 	/*
278 	 * We need to hard disable to get a trusted value from
279 	 * __check_irq_replay(). We also need to soft-disable
280 	 * again to avoid warnings in there due to the use of
281 	 * per-cpu variables.
282 	 */
283 	if (!(irq_happened & PACA_IRQ_HARD_DIS)) {
284 #ifdef CONFIG_PPC_IRQ_SOFT_MASK_DEBUG
285 		WARN_ON(!(mfmsr() & MSR_EE));
286 #endif
287 		__hard_irq_disable();
288 #ifdef CONFIG_PPC_IRQ_SOFT_MASK_DEBUG
289 	} else {
290 		/*
291 		 * We should already be hard disabled here. We had bugs
292 		 * where that wasn't the case so let's dbl check it and
293 		 * warn if we are wrong. Only do that when IRQ tracing
294 		 * is enabled as mfmsr() can be costly.
295 		 */
296 		if (WARN_ON(mfmsr() & MSR_EE))
297 			__hard_irq_disable();
298 #endif
299 	}
300 
301 	irq_soft_mask_set(IRQS_ALL_DISABLED);
302 	trace_hardirqs_off();
303 
304 	/*
305 	 * Check if anything needs to be re-emitted. We haven't
306 	 * soft-enabled yet to avoid warnings in decrementer_check_overflow
307 	 * accessing per-cpu variables
308 	 */
309 	replay = __check_irq_replay();
310 
311 	/* We can soft-enable now */
312 	trace_hardirqs_on();
313 	irq_soft_mask_set(IRQS_ENABLED);
314 
315 	/*
316 	 * And replay if we have to. This will return with interrupts
317 	 * hard-enabled.
318 	 */
319 	if (replay) {
320 		__replay_interrupt(replay);
321 		return;
322 	}
323 
324 	/* Finally, let's ensure we are hard enabled */
325 	__hard_irq_enable();
326 }
327 EXPORT_SYMBOL(arch_local_irq_restore);
328 
329 /*
330  * This is specifically called by assembly code to re-enable interrupts
331  * if they are currently disabled. This is typically called before
332  * schedule() or do_signal() when returning to userspace. We do it
333  * in C to avoid the burden of dealing with lockdep etc...
334  *
335  * NOTE: This is called with interrupts hard disabled but not marked
336  * as such in paca->irq_happened, so we need to resync this.
337  */
restore_interrupts(void)338 void notrace restore_interrupts(void)
339 {
340 	if (irqs_disabled()) {
341 		local_paca->irq_happened |= PACA_IRQ_HARD_DIS;
342 		local_irq_enable();
343 	} else
344 		__hard_irq_enable();
345 }
346 
347 /*
348  * This is a helper to use when about to go into idle low-power
349  * when the latter has the side effect of re-enabling interrupts
350  * (such as calling H_CEDE under pHyp).
351  *
352  * You call this function with interrupts soft-disabled (this is
353  * already the case when ppc_md.power_save is called). The function
354  * will return whether to enter power save or just return.
355  *
356  * In the former case, it will have notified lockdep of interrupts
357  * being re-enabled and generally sanitized the lazy irq state,
358  * and in the latter case it will leave with interrupts hard
359  * disabled and marked as such, so the local_irq_enable() call
360  * in arch_cpu_idle() will properly re-enable everything.
361  */
prep_irq_for_idle(void)362 bool prep_irq_for_idle(void)
363 {
364 	/*
365 	 * First we need to hard disable to ensure no interrupt
366 	 * occurs before we effectively enter the low power state
367 	 */
368 	__hard_irq_disable();
369 	local_paca->irq_happened |= PACA_IRQ_HARD_DIS;
370 
371 	/*
372 	 * If anything happened while we were soft-disabled,
373 	 * we return now and do not enter the low power state.
374 	 */
375 	if (lazy_irq_pending())
376 		return false;
377 
378 	/* Tell lockdep we are about to re-enable */
379 	trace_hardirqs_on();
380 
381 	/*
382 	 * Mark interrupts as soft-enabled and clear the
383 	 * PACA_IRQ_HARD_DIS from the pending mask since we
384 	 * are about to hard enable as well as a side effect
385 	 * of entering the low power state.
386 	 */
387 	local_paca->irq_happened &= ~PACA_IRQ_HARD_DIS;
388 	irq_soft_mask_set(IRQS_ENABLED);
389 
390 	/* Tell the caller to enter the low power state */
391 	return true;
392 }
393 
394 #ifdef CONFIG_PPC_BOOK3S
395 /*
396  * This is for idle sequences that return with IRQs off, but the
397  * idle state itself wakes on interrupt. Tell the irq tracer that
398  * IRQs are enabled for the duration of idle so it does not get long
399  * off times. Must be paired with fini_irq_for_idle_irqsoff.
400  */
prep_irq_for_idle_irqsoff(void)401 bool prep_irq_for_idle_irqsoff(void)
402 {
403 	WARN_ON(!irqs_disabled());
404 
405 	/*
406 	 * First we need to hard disable to ensure no interrupt
407 	 * occurs before we effectively enter the low power state
408 	 */
409 	__hard_irq_disable();
410 	local_paca->irq_happened |= PACA_IRQ_HARD_DIS;
411 
412 	/*
413 	 * If anything happened while we were soft-disabled,
414 	 * we return now and do not enter the low power state.
415 	 */
416 	if (lazy_irq_pending())
417 		return false;
418 
419 	/* Tell lockdep we are about to re-enable */
420 	trace_hardirqs_on();
421 
422 	return true;
423 }
424 
425 /*
426  * Take the SRR1 wakeup reason, index into this table to find the
427  * appropriate irq_happened bit.
428  *
429  * Sytem reset exceptions taken in idle state also come through here,
430  * but they are NMI interrupts so do not need to wait for IRQs to be
431  * restored, and should be taken as early as practical. These are marked
432  * with 0xff in the table. The Power ISA specifies 0100b as the system
433  * reset interrupt reason.
434  */
435 #define IRQ_SYSTEM_RESET	0xff
436 
437 static const u8 srr1_to_lazyirq[0x10] = {
438 	0, 0, 0,
439 	PACA_IRQ_DBELL,
440 	IRQ_SYSTEM_RESET,
441 	PACA_IRQ_DBELL,
442 	PACA_IRQ_DEC,
443 	0,
444 	PACA_IRQ_EE,
445 	PACA_IRQ_EE,
446 	PACA_IRQ_HMI,
447 	0, 0, 0, 0, 0 };
448 
replay_system_reset(void)449 void replay_system_reset(void)
450 {
451 	struct pt_regs regs;
452 
453 	ppc_save_regs(&regs);
454 	regs.trap = 0x100;
455 	get_paca()->in_nmi = 1;
456 	system_reset_exception(&regs);
457 	get_paca()->in_nmi = 0;
458 }
459 EXPORT_SYMBOL_GPL(replay_system_reset);
460 
irq_set_pending_from_srr1(unsigned long srr1)461 void irq_set_pending_from_srr1(unsigned long srr1)
462 {
463 	unsigned int idx = (srr1 & SRR1_WAKEMASK_P8) >> 18;
464 	u8 reason = srr1_to_lazyirq[idx];
465 
466 	/*
467 	 * Take the system reset now, which is immediately after registers
468 	 * are restored from idle. It's an NMI, so interrupts need not be
469 	 * re-enabled before it is taken.
470 	 */
471 	if (unlikely(reason == IRQ_SYSTEM_RESET)) {
472 		replay_system_reset();
473 		return;
474 	}
475 
476 	/*
477 	 * The 0 index (SRR1[42:45]=b0000) must always evaluate to 0,
478 	 * so this can be called unconditionally with the SRR1 wake
479 	 * reason as returned by the idle code, which uses 0 to mean no
480 	 * interrupt.
481 	 *
482 	 * If a future CPU was to designate this as an interrupt reason,
483 	 * then a new index for no interrupt must be assigned.
484 	 */
485 	local_paca->irq_happened |= reason;
486 }
487 #endif /* CONFIG_PPC_BOOK3S */
488 
489 /*
490  * Force a replay of the external interrupt handler on this CPU.
491  */
force_external_irq_replay(void)492 void force_external_irq_replay(void)
493 {
494 	/*
495 	 * This must only be called with interrupts soft-disabled,
496 	 * the replay will happen when re-enabling.
497 	 */
498 	WARN_ON(!arch_irqs_disabled());
499 
500 	/*
501 	 * Interrupts must always be hard disabled before irq_happened is
502 	 * modified (to prevent lost update in case of interrupt between
503 	 * load and store).
504 	 */
505 	__hard_irq_disable();
506 	local_paca->irq_happened |= PACA_IRQ_HARD_DIS;
507 
508 	/* Indicate in the PACA that we have an interrupt to replay */
509 	local_paca->irq_happened |= PACA_IRQ_EE;
510 }
511 
512 #endif /* CONFIG_PPC64 */
513 
arch_show_interrupts(struct seq_file * p,int prec)514 int arch_show_interrupts(struct seq_file *p, int prec)
515 {
516 	int j;
517 
518 #if defined(CONFIG_PPC32) && defined(CONFIG_TAU_INT)
519 	if (tau_initialized) {
520 		seq_printf(p, "%*s: ", prec, "TAU");
521 		for_each_online_cpu(j)
522 			seq_printf(p, "%10u ", tau_interrupts(j));
523 		seq_puts(p, "  PowerPC             Thermal Assist (cpu temp)\n");
524 	}
525 #endif /* CONFIG_PPC32 && CONFIG_TAU_INT */
526 
527 	seq_printf(p, "%*s: ", prec, "LOC");
528 	for_each_online_cpu(j)
529 		seq_printf(p, "%10u ", per_cpu(irq_stat, j).timer_irqs_event);
530         seq_printf(p, "  Local timer interrupts for timer event device\n");
531 
532 	seq_printf(p, "%*s: ", prec, "BCT");
533 	for_each_online_cpu(j)
534 		seq_printf(p, "%10u ", per_cpu(irq_stat, j).broadcast_irqs_event);
535 	seq_printf(p, "  Broadcast timer interrupts for timer event device\n");
536 
537 	seq_printf(p, "%*s: ", prec, "LOC");
538 	for_each_online_cpu(j)
539 		seq_printf(p, "%10u ", per_cpu(irq_stat, j).timer_irqs_others);
540         seq_printf(p, "  Local timer interrupts for others\n");
541 
542 	seq_printf(p, "%*s: ", prec, "SPU");
543 	for_each_online_cpu(j)
544 		seq_printf(p, "%10u ", per_cpu(irq_stat, j).spurious_irqs);
545 	seq_printf(p, "  Spurious interrupts\n");
546 
547 	seq_printf(p, "%*s: ", prec, "PMI");
548 	for_each_online_cpu(j)
549 		seq_printf(p, "%10u ", per_cpu(irq_stat, j).pmu_irqs);
550 	seq_printf(p, "  Performance monitoring interrupts\n");
551 
552 	seq_printf(p, "%*s: ", prec, "MCE");
553 	for_each_online_cpu(j)
554 		seq_printf(p, "%10u ", per_cpu(irq_stat, j).mce_exceptions);
555 	seq_printf(p, "  Machine check exceptions\n");
556 
557 	if (cpu_has_feature(CPU_FTR_HVMODE)) {
558 		seq_printf(p, "%*s: ", prec, "HMI");
559 		for_each_online_cpu(j)
560 			seq_printf(p, "%10u ",
561 					per_cpu(irq_stat, j).hmi_exceptions);
562 		seq_printf(p, "  Hypervisor Maintenance Interrupts\n");
563 	}
564 
565 	seq_printf(p, "%*s: ", prec, "NMI");
566 	for_each_online_cpu(j)
567 		seq_printf(p, "%10u ", per_cpu(irq_stat, j).sreset_irqs);
568 	seq_printf(p, "  System Reset interrupts\n");
569 
570 #ifdef CONFIG_PPC_WATCHDOG
571 	seq_printf(p, "%*s: ", prec, "WDG");
572 	for_each_online_cpu(j)
573 		seq_printf(p, "%10u ", per_cpu(irq_stat, j).soft_nmi_irqs);
574 	seq_printf(p, "  Watchdog soft-NMI interrupts\n");
575 #endif
576 
577 #ifdef CONFIG_PPC_DOORBELL
578 	if (cpu_has_feature(CPU_FTR_DBELL)) {
579 		seq_printf(p, "%*s: ", prec, "DBL");
580 		for_each_online_cpu(j)
581 			seq_printf(p, "%10u ", per_cpu(irq_stat, j).doorbell_irqs);
582 		seq_printf(p, "  Doorbell interrupts\n");
583 	}
584 #endif
585 
586 	return 0;
587 }
588 
589 /*
590  * /proc/stat helpers
591  */
arch_irq_stat_cpu(unsigned int cpu)592 u64 arch_irq_stat_cpu(unsigned int cpu)
593 {
594 	u64 sum = per_cpu(irq_stat, cpu).timer_irqs_event;
595 
596 	sum += per_cpu(irq_stat, cpu).broadcast_irqs_event;
597 	sum += per_cpu(irq_stat, cpu).pmu_irqs;
598 	sum += per_cpu(irq_stat, cpu).mce_exceptions;
599 	sum += per_cpu(irq_stat, cpu).spurious_irqs;
600 	sum += per_cpu(irq_stat, cpu).timer_irqs_others;
601 	sum += per_cpu(irq_stat, cpu).hmi_exceptions;
602 	sum += per_cpu(irq_stat, cpu).sreset_irqs;
603 #ifdef CONFIG_PPC_WATCHDOG
604 	sum += per_cpu(irq_stat, cpu).soft_nmi_irqs;
605 #endif
606 #ifdef CONFIG_PPC_DOORBELL
607 	sum += per_cpu(irq_stat, cpu).doorbell_irqs;
608 #endif
609 
610 	return sum;
611 }
612 
check_stack_overflow(void)613 static inline void check_stack_overflow(void)
614 {
615 #ifdef CONFIG_DEBUG_STACKOVERFLOW
616 	long sp;
617 
618 	sp = current_stack_pointer() & (THREAD_SIZE-1);
619 
620 	/* check for stack overflow: is there less than 2KB free? */
621 	if (unlikely(sp < (sizeof(struct thread_info) + 2048))) {
622 		pr_err("do_IRQ: stack overflow: %ld\n",
623 			sp - sizeof(struct thread_info));
624 		dump_stack();
625 	}
626 #endif
627 }
628 
__do_irq(struct pt_regs * regs)629 void __do_irq(struct pt_regs *regs)
630 {
631 	unsigned int irq;
632 
633 	irq_enter();
634 
635 	trace_irq_entry(regs);
636 
637 	check_stack_overflow();
638 
639 	/*
640 	 * Query the platform PIC for the interrupt & ack it.
641 	 *
642 	 * This will typically lower the interrupt line to the CPU
643 	 */
644 	irq = ppc_md.get_irq();
645 
646 	/* We can hard enable interrupts now to allow perf interrupts */
647 	may_hard_irq_enable();
648 
649 	/* And finally process it */
650 	if (unlikely(!irq))
651 		__this_cpu_inc(irq_stat.spurious_irqs);
652 	else
653 		generic_handle_irq(irq);
654 
655 	trace_irq_exit(regs);
656 
657 	irq_exit();
658 }
659 
do_IRQ(struct pt_regs * regs)660 void do_IRQ(struct pt_regs *regs)
661 {
662 	struct pt_regs *old_regs = set_irq_regs(regs);
663 	struct thread_info *curtp, *irqtp, *sirqtp;
664 
665 	/* Switch to the irq stack to handle this */
666 	curtp = current_thread_info();
667 	irqtp = hardirq_ctx[raw_smp_processor_id()];
668 	sirqtp = softirq_ctx[raw_smp_processor_id()];
669 
670 	/* Already there ? */
671 	if (unlikely(curtp == irqtp || curtp == sirqtp)) {
672 		__do_irq(regs);
673 		set_irq_regs(old_regs);
674 		return;
675 	}
676 
677 	/* Prepare the thread_info in the irq stack */
678 	irqtp->task = curtp->task;
679 	irqtp->flags = 0;
680 
681 	/* Copy the preempt_count so that the [soft]irq checks work. */
682 	irqtp->preempt_count = curtp->preempt_count;
683 
684 	/* Switch stack and call */
685 	call_do_irq(regs, irqtp);
686 
687 	/* Restore stack limit */
688 	irqtp->task = NULL;
689 
690 	/* Copy back updates to the thread_info */
691 	if (irqtp->flags)
692 		set_bits(irqtp->flags, &curtp->flags);
693 
694 	set_irq_regs(old_regs);
695 }
696 
init_IRQ(void)697 void __init init_IRQ(void)
698 {
699 	if (ppc_md.init_IRQ)
700 		ppc_md.init_IRQ();
701 
702 	exc_lvl_ctx_init();
703 
704 	irq_ctx_init();
705 }
706 
707 #if defined(CONFIG_BOOKE) || defined(CONFIG_40x)
708 struct thread_info   *critirq_ctx[NR_CPUS] __read_mostly;
709 struct thread_info    *dbgirq_ctx[NR_CPUS] __read_mostly;
710 struct thread_info *mcheckirq_ctx[NR_CPUS] __read_mostly;
711 
exc_lvl_ctx_init(void)712 void exc_lvl_ctx_init(void)
713 {
714 	struct thread_info *tp;
715 	int i, cpu_nr;
716 
717 	for_each_possible_cpu(i) {
718 #ifdef CONFIG_PPC64
719 		cpu_nr = i;
720 #else
721 #ifdef CONFIG_SMP
722 		cpu_nr = get_hard_smp_processor_id(i);
723 #else
724 		cpu_nr = 0;
725 #endif
726 #endif
727 
728 		memset((void *)critirq_ctx[cpu_nr], 0, THREAD_SIZE);
729 		tp = critirq_ctx[cpu_nr];
730 		tp->cpu = cpu_nr;
731 		tp->preempt_count = 0;
732 
733 #ifdef CONFIG_BOOKE
734 		memset((void *)dbgirq_ctx[cpu_nr], 0, THREAD_SIZE);
735 		tp = dbgirq_ctx[cpu_nr];
736 		tp->cpu = cpu_nr;
737 		tp->preempt_count = 0;
738 
739 		memset((void *)mcheckirq_ctx[cpu_nr], 0, THREAD_SIZE);
740 		tp = mcheckirq_ctx[cpu_nr];
741 		tp->cpu = cpu_nr;
742 		tp->preempt_count = HARDIRQ_OFFSET;
743 #endif
744 	}
745 }
746 #endif
747 
748 struct thread_info *softirq_ctx[NR_CPUS] __read_mostly;
749 struct thread_info *hardirq_ctx[NR_CPUS] __read_mostly;
750 
irq_ctx_init(void)751 void irq_ctx_init(void)
752 {
753 	struct thread_info *tp;
754 	int i;
755 
756 	for_each_possible_cpu(i) {
757 		memset((void *)softirq_ctx[i], 0, THREAD_SIZE);
758 		tp = softirq_ctx[i];
759 		tp->cpu = i;
760 		klp_init_thread_info(tp);
761 
762 		memset((void *)hardirq_ctx[i], 0, THREAD_SIZE);
763 		tp = hardirq_ctx[i];
764 		tp->cpu = i;
765 		klp_init_thread_info(tp);
766 	}
767 }
768 
do_softirq_own_stack(void)769 void do_softirq_own_stack(void)
770 {
771 	struct thread_info *curtp, *irqtp;
772 
773 	curtp = current_thread_info();
774 	irqtp = softirq_ctx[smp_processor_id()];
775 	irqtp->task = curtp->task;
776 	irqtp->flags = 0;
777 	call_do_softirq(irqtp);
778 	irqtp->task = NULL;
779 
780 	/* Set any flag that may have been set on the
781 	 * alternate stack
782 	 */
783 	if (irqtp->flags)
784 		set_bits(irqtp->flags, &curtp->flags);
785 }
786 
virq_to_hw(unsigned int virq)787 irq_hw_number_t virq_to_hw(unsigned int virq)
788 {
789 	struct irq_data *irq_data = irq_get_irq_data(virq);
790 	return WARN_ON(!irq_data) ? 0 : irq_data->hwirq;
791 }
792 EXPORT_SYMBOL_GPL(virq_to_hw);
793 
794 #ifdef CONFIG_SMP
irq_choose_cpu(const struct cpumask * mask)795 int irq_choose_cpu(const struct cpumask *mask)
796 {
797 	int cpuid;
798 
799 	if (cpumask_equal(mask, cpu_online_mask)) {
800 		static int irq_rover;
801 		static DEFINE_RAW_SPINLOCK(irq_rover_lock);
802 		unsigned long flags;
803 
804 		/* Round-robin distribution... */
805 do_round_robin:
806 		raw_spin_lock_irqsave(&irq_rover_lock, flags);
807 
808 		irq_rover = cpumask_next(irq_rover, cpu_online_mask);
809 		if (irq_rover >= nr_cpu_ids)
810 			irq_rover = cpumask_first(cpu_online_mask);
811 
812 		cpuid = irq_rover;
813 
814 		raw_spin_unlock_irqrestore(&irq_rover_lock, flags);
815 	} else {
816 		cpuid = cpumask_first_and(mask, cpu_online_mask);
817 		if (cpuid >= nr_cpu_ids)
818 			goto do_round_robin;
819 	}
820 
821 	return get_hard_smp_processor_id(cpuid);
822 }
823 #else
irq_choose_cpu(const struct cpumask * mask)824 int irq_choose_cpu(const struct cpumask *mask)
825 {
826 	return hard_smp_processor_id();
827 }
828 #endif
829 
arch_early_irq_init(void)830 int arch_early_irq_init(void)
831 {
832 	return 0;
833 }
834 
835 #ifdef CONFIG_PPC64
setup_noirqdistrib(char * str)836 static int __init setup_noirqdistrib(char *str)
837 {
838 	distribute_irqs = 0;
839 	return 1;
840 }
841 
842 __setup("noirqdistrib", setup_noirqdistrib);
843 #endif /* CONFIG_PPC64 */
844