manage.c 41.6 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3
/*
 * linux/kernel/irq/manage.c
 *
I
Ingo Molnar 已提交
4 5
 * Copyright (C) 1992, 1998-2006 Linus Torvalds, Ingo Molnar
 * Copyright (C) 2005-2006 Thomas Gleixner
L
Linus Torvalds 已提交
6 7 8 9 10
 *
 * This file contains driver APIs to the irq subsystem.
 */

#include <linux/irq.h>
11
#include <linux/kthread.h>
L
Linus Torvalds 已提交
12 13 14
#include <linux/module.h>
#include <linux/random.h>
#include <linux/interrupt.h>
15
#include <linux/slab.h>
16
#include <linux/sched.h>
L
Linus Torvalds 已提交
17 18 19

#include "internals.h"

20 21 22 23 24 25 26 27 28 29 30
#ifdef CONFIG_IRQ_FORCED_THREADING
__read_mostly bool force_irqthreads;

static int __init setup_forced_irqthreads(char *arg)
{
	force_irqthreads = true;
	return 0;
}
early_param("threadirqs", setup_forced_irqthreads);
#endif

L
Linus Torvalds 已提交
31 32
/**
 *	synchronize_irq - wait for pending IRQ handlers (on other CPUs)
33
 *	@irq: interrupt number to wait for
L
Linus Torvalds 已提交
34 35 36 37 38 39 40 41 42
 *
 *	This function waits for any pending IRQ handlers for this interrupt
 *	to complete before returning. If you use this function while
 *	holding a resource the IRQ handler may need you will deadlock.
 *
 *	This function may be called - with care - from IRQ context.
 */
void synchronize_irq(unsigned int irq)
{
43
	struct irq_desc *desc = irq_to_desc(irq);
44
	bool inprogress;
L
Linus Torvalds 已提交
45

46
	if (!desc)
47 48
		return;

49 50 51 52 53 54 55
	do {
		unsigned long flags;

		/*
		 * Wait until we're out of the critical section.  This might
		 * give the wrong answer due to the lack of memory barriers.
		 */
56
		while (irqd_irq_inprogress(&desc->irq_data))
57 58 59
			cpu_relax();

		/* Ok, that indicated we're done: double-check carefully. */
60
		raw_spin_lock_irqsave(&desc->lock, flags);
61
		inprogress = irqd_irq_inprogress(&desc->irq_data);
62
		raw_spin_unlock_irqrestore(&desc->lock, flags);
63 64

		/* Oops, that failed? */
65
	} while (inprogress);
66 67 68 69 70 71

	/*
	 * We made sure that no hardirq handler is running. Now verify
	 * that no threaded handlers are active.
	 */
	wait_event(desc->wait_for_threads, !atomic_read(&desc->threads_active));
L
Linus Torvalds 已提交
72 73 74
}
EXPORT_SYMBOL(synchronize_irq);

75 76 77
#ifdef CONFIG_SMP
cpumask_var_t irq_default_affinity;

78 79 80 81 82 83 84
/**
 *	irq_can_set_affinity - Check if the affinity of a given irq can be set
 *	@irq:		Interrupt to check
 *
 */
int irq_can_set_affinity(unsigned int irq)
{
85
	struct irq_desc *desc = irq_to_desc(irq);
86

87 88
	if (!desc || !irqd_can_balance(&desc->irq_data) ||
	    !desc->irq_data.chip || !desc->irq_data.chip->irq_set_affinity)
89 90 91 92 93
		return 0;

	return 1;
}

94 95 96 97 98 99 100 101 102 103
/**
 *	irq_set_thread_affinity - Notify irq threads to adjust affinity
 *	@desc:		irq descriptor which has affitnity changed
 *
 *	We just set IRQTF_AFFINITY and delegate the affinity setting
 *	to the interrupt thread itself. We can not call
 *	set_cpus_allowed_ptr() here as we hold desc->lock and this
 *	code can be called from hard interrupt context.
 */
void irq_set_thread_affinity(struct irq_desc *desc)
104 105 106 107 108
{
	struct irqaction *action = desc->action;

	while (action) {
		if (action->thread)
109
			set_bit(IRQTF_AFFINITY, &action->thread_flags);
110 111 112 113
		action = action->next;
	}
}

114
#ifdef CONFIG_GENERIC_PENDING_IRQ
T
Thomas Gleixner 已提交
115
static inline bool irq_can_move_pcntxt(struct irq_data *data)
116
{
T
Thomas Gleixner 已提交
117
	return irqd_can_move_in_process_context(data);
118
}
T
Thomas Gleixner 已提交
119
static inline bool irq_move_pending(struct irq_data *data)
120
{
T
Thomas Gleixner 已提交
121
	return irqd_is_setaffinity_pending(data);
122 123 124 125 126 127 128 129 130 131 132 133
}
static inline void
irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask)
{
	cpumask_copy(desc->pending_mask, mask);
}
static inline void
irq_get_pending(struct cpumask *mask, struct irq_desc *desc)
{
	cpumask_copy(mask, desc->pending_mask);
}
#else
T
Thomas Gleixner 已提交
134
static inline bool irq_can_move_pcntxt(struct irq_data *data) { return true; }
T
Thomas Gleixner 已提交
135
static inline bool irq_move_pending(struct irq_data *data) { return false; }
136 137 138 139 140 141
static inline void
irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask) { }
static inline void
irq_get_pending(struct cpumask *mask, struct irq_desc *desc) { }
#endif

142
int __irq_set_affinity_locked(struct irq_data *data, const struct cpumask *mask)
143
{
144 145
	struct irq_chip *chip = irq_data_get_irq_chip(data);
	struct irq_desc *desc = irq_data_to_desc(data);
146
	int ret = 0;
147

148
	if (!chip || !chip->irq_set_affinity)
149 150
		return -EINVAL;

T
Thomas Gleixner 已提交
151
	if (irq_can_move_pcntxt(data)) {
152
		ret = chip->irq_set_affinity(data, mask, false);
153 154
		switch (ret) {
		case IRQ_SET_MASK_OK:
155
			cpumask_copy(data->affinity, mask);
156
		case IRQ_SET_MASK_OK_NOCOPY:
157
			irq_set_thread_affinity(desc);
158
			ret = 0;
159
		}
160
	} else {
161
		irqd_set_move_pending(data);
162
		irq_copy_pending(desc, mask);
163
	}
164

165 166 167 168
	if (desc->affinity_notify) {
		kref_get(&desc->affinity_notify->kref);
		schedule_work(&desc->affinity_notify->work);
	}
169 170 171 172 173 174 175 176
	irqd_set(data, IRQD_AFFINITY_SET);

	return ret;
}

/**
 *	irq_set_affinity - Set the irq affinity of a given irq
 *	@irq:		Interrupt to set affinity
177
 *	@mask:		cpumask
178 179 180 181 182 183 184 185 186 187 188 189 190
 *
 */
int irq_set_affinity(unsigned int irq, const struct cpumask *mask)
{
	struct irq_desc *desc = irq_to_desc(irq);
	unsigned long flags;
	int ret;

	if (!desc)
		return -EINVAL;

	raw_spin_lock_irqsave(&desc->lock, flags);
	ret =  __irq_set_affinity_locked(irq_desc_get_irq_data(desc), mask);
191
	raw_spin_unlock_irqrestore(&desc->lock, flags);
192
	return ret;
193 194
}

195 196 197
int irq_set_affinity_hint(unsigned int irq, const struct cpumask *m)
{
	unsigned long flags;
198
	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
199 200 201 202

	if (!desc)
		return -EINVAL;
	desc->affinity_hint = m;
203
	irq_put_desc_unlock(desc, flags);
204 205 206 207
	return 0;
}
EXPORT_SYMBOL_GPL(irq_set_affinity_hint);

208 209 210 211 212 213 214 215
static void irq_affinity_notify(struct work_struct *work)
{
	struct irq_affinity_notify *notify =
		container_of(work, struct irq_affinity_notify, work);
	struct irq_desc *desc = irq_to_desc(notify->irq);
	cpumask_var_t cpumask;
	unsigned long flags;

216
	if (!desc || !alloc_cpumask_var(&cpumask, GFP_KERNEL))
217 218 219
		goto out;

	raw_spin_lock_irqsave(&desc->lock, flags);
T
Thomas Gleixner 已提交
220
	if (irq_move_pending(&desc->irq_data))
221
		irq_get_pending(cpumask, desc);
222
	else
223
		cpumask_copy(cpumask, desc->irq_data.affinity);
224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275
	raw_spin_unlock_irqrestore(&desc->lock, flags);

	notify->notify(notify, cpumask);

	free_cpumask_var(cpumask);
out:
	kref_put(&notify->kref, notify->release);
}

/**
 *	irq_set_affinity_notifier - control notification of IRQ affinity changes
 *	@irq:		Interrupt for which to enable/disable notification
 *	@notify:	Context for notification, or %NULL to disable
 *			notification.  Function pointers must be initialised;
 *			the other fields will be initialised by this function.
 *
 *	Must be called in process context.  Notification may only be enabled
 *	after the IRQ is allocated and must be disabled before the IRQ is
 *	freed using free_irq().
 */
int
irq_set_affinity_notifier(unsigned int irq, struct irq_affinity_notify *notify)
{
	struct irq_desc *desc = irq_to_desc(irq);
	struct irq_affinity_notify *old_notify;
	unsigned long flags;

	/* The release function is promised process context */
	might_sleep();

	if (!desc)
		return -EINVAL;

	/* Complete initialisation of *notify */
	if (notify) {
		notify->irq = irq;
		kref_init(&notify->kref);
		INIT_WORK(&notify->work, irq_affinity_notify);
	}

	raw_spin_lock_irqsave(&desc->lock, flags);
	old_notify = desc->affinity_notify;
	desc->affinity_notify = notify;
	raw_spin_unlock_irqrestore(&desc->lock, flags);

	if (old_notify)
		kref_put(&old_notify->kref, old_notify->release);

	return 0;
}
EXPORT_SYMBOL_GPL(irq_set_affinity_notifier);

276 277 278 279
#ifndef CONFIG_AUTO_IRQ_AFFINITY
/*
 * Generic version of the affinity autoselector.
 */
280 281
static int
setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask)
282
{
283
	struct irq_chip *chip = irq_desc_get_chip(desc);
284
	struct cpumask *set = irq_default_affinity;
285
	int ret;
286

287
	/* Excludes PER_CPU and NO_BALANCE interrupts */
288 289 290
	if (!irq_can_set_affinity(irq))
		return 0;

291 292 293 294
	/*
	 * Preserve an userspace affinity setup, but make sure that
	 * one of the targets is online.
	 */
295
	if (irqd_has_set(&desc->irq_data, IRQD_AFFINITY_SET)) {
296 297 298
		if (cpumask_intersects(desc->irq_data.affinity,
				       cpu_online_mask))
			set = desc->irq_data.affinity;
T
Thomas Gleixner 已提交
299
		else
300
			irqd_clear(&desc->irq_data, IRQD_AFFINITY_SET);
301
	}
302

303 304 305 306 307 308 309 310
	cpumask_and(mask, cpu_online_mask, set);
	ret = chip->irq_set_affinity(&desc->irq_data, mask, false);
	switch (ret) {
	case IRQ_SET_MASK_OK:
		cpumask_copy(desc->irq_data.affinity, mask);
	case IRQ_SET_MASK_OK_NOCOPY:
		irq_set_thread_affinity(desc);
	}
311 312
	return 0;
}
313
#else
314 315
static inline int
setup_affinity(unsigned int irq, struct irq_desc *d, struct cpumask *mask)
316 317 318
{
	return irq_select_affinity(irq);
}
319 320
#endif

321 322 323
/*
 * Called when affinity is set via /proc/irq
 */
324
int irq_select_affinity_usr(unsigned int irq, struct cpumask *mask)
325 326 327 328 329
{
	struct irq_desc *desc = irq_to_desc(irq);
	unsigned long flags;
	int ret;

330
	raw_spin_lock_irqsave(&desc->lock, flags);
331
	ret = setup_affinity(irq, desc, mask);
332
	raw_spin_unlock_irqrestore(&desc->lock, flags);
333 334 335 336
	return ret;
}

#else
337 338
static inline int
setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask)
339 340 341
{
	return 0;
}
L
Linus Torvalds 已提交
342 343
#endif

344 345 346
void __disable_irq(struct irq_desc *desc, unsigned int irq, bool suspend)
{
	if (suspend) {
347
		if (!desc->action || (desc->action->flags & IRQF_NO_SUSPEND))
348
			return;
349
		desc->istate |= IRQS_SUSPENDED;
350 351
	}

352
	if (!desc->depth++)
353
		irq_disable(desc);
354 355
}

356 357 358
static int __disable_irq_nosync(unsigned int irq)
{
	unsigned long flags;
359
	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
360 361 362 363 364 365 366 367

	if (!desc)
		return -EINVAL;
	__disable_irq(desc, irq, false);
	irq_put_desc_busunlock(desc, flags);
	return 0;
}

L
Linus Torvalds 已提交
368 369 370 371 372 373 374 375 376 377 378 379 380
/**
 *	disable_irq_nosync - disable an irq without waiting
 *	@irq: Interrupt to disable
 *
 *	Disable the selected interrupt line.  Disables and Enables are
 *	nested.
 *	Unlike disable_irq(), this function does not ensure existing
 *	instances of the IRQ handler have completed before returning.
 *
 *	This function may be called from IRQ context.
 */
void disable_irq_nosync(unsigned int irq)
{
381
	__disable_irq_nosync(irq);
L
Linus Torvalds 已提交
382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398
}
EXPORT_SYMBOL(disable_irq_nosync);

/**
 *	disable_irq - disable an irq and wait for completion
 *	@irq: Interrupt to disable
 *
 *	Disable the selected interrupt line.  Enables and Disables are
 *	nested.
 *	This function waits for any pending IRQ handlers for this interrupt
 *	to complete before returning. If you use this function while
 *	holding a resource the IRQ handler may need you will deadlock.
 *
 *	This function may be called - with care - from IRQ context.
 */
void disable_irq(unsigned int irq)
{
399
	if (!__disable_irq_nosync(irq))
L
Linus Torvalds 已提交
400 401 402 403
		synchronize_irq(irq);
}
EXPORT_SYMBOL(disable_irq);

404
void __enable_irq(struct irq_desc *desc, unsigned int irq, bool resume)
405
{
T
Thomas Gleixner 已提交
406
	if (resume) {
407
		if (!(desc->istate & IRQS_SUSPENDED)) {
T
Thomas Gleixner 已提交
408 409 410 411 412 413 414
			if (!desc->action)
				return;
			if (!(desc->action->flags & IRQF_FORCE_RESUME))
				return;
			/* Pretend that it got disabled ! */
			desc->depth++;
		}
415
		desc->istate &= ~IRQS_SUSPENDED;
T
Thomas Gleixner 已提交
416
	}
417

418 419
	switch (desc->depth) {
	case 0:
420
 err_out:
421
		WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n", irq);
422 423
		break;
	case 1: {
424
		if (desc->istate & IRQS_SUSPENDED)
425
			goto err_out;
426
		/* Prevent probing on this irq: */
427
		irq_settings_set_noprobe(desc);
428
		irq_enable(desc);
429 430 431 432 433 434 435 436
		check_irq_resend(desc, irq);
		/* fall-through */
	}
	default:
		desc->depth--;
	}
}

L
Linus Torvalds 已提交
437 438 439 440 441 442 443 444
/**
 *	enable_irq - enable handling of an irq
 *	@irq: Interrupt to enable
 *
 *	Undoes the effect of one call to disable_irq().  If this
 *	matches the last disable, processing of interrupts on this
 *	IRQ line is re-enabled.
 *
T
Thomas Gleixner 已提交
445
 *	This function may be called from IRQ context only when
446
 *	desc->irq_data.chip->bus_lock and desc->chip->bus_sync_unlock are NULL !
L
Linus Torvalds 已提交
447 448 449 450
 */
void enable_irq(unsigned int irq)
{
	unsigned long flags;
451
	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
L
Linus Torvalds 已提交
452

453
	if (!desc)
454
		return;
T
Thomas Gleixner 已提交
455 456
	if (WARN(!desc->irq_data.chip,
		 KERN_ERR "enable_irq before setup/request_irq: irq %u\n", irq))
457
		goto out;
458

459
	__enable_irq(desc, irq, false);
460 461
out:
	irq_put_desc_busunlock(desc, flags);
L
Linus Torvalds 已提交
462 463 464
}
EXPORT_SYMBOL(enable_irq);

D
David Brownell 已提交
465
static int set_irq_wake_real(unsigned int irq, unsigned int on)
466
{
467
	struct irq_desc *desc = irq_to_desc(irq);
468 469
	int ret = -ENXIO;

470 471 472
	if (irq_desc_get_chip(desc)->flags &  IRQCHIP_SKIP_SET_WAKE)
		return 0;

473 474
	if (desc->irq_data.chip->irq_set_wake)
		ret = desc->irq_data.chip->irq_set_wake(&desc->irq_data, on);
475 476 477 478

	return ret;
}

479
/**
T
Thomas Gleixner 已提交
480
 *	irq_set_irq_wake - control irq power management wakeup
481 482 483
 *	@irq:	interrupt to control
 *	@on:	enable/disable power management wakeup
 *
484 485 486 487 488 489
 *	Enable/disable power management wakeup mode, which is
 *	disabled by default.  Enables and disables must match,
 *	just as they match for non-wakeup mode support.
 *
 *	Wakeup mode lets this IRQ wake the system from sleep
 *	states like "suspend to RAM".
490
 */
T
Thomas Gleixner 已提交
491
int irq_set_irq_wake(unsigned int irq, unsigned int on)
492 493
{
	unsigned long flags;
494
	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
495
	int ret = 0;
496

497 498 499
	if (!desc)
		return -EINVAL;

500 501 502 503
	/* wakeup-capable irqs can be shared between drivers that
	 * don't need to have the same sleep mode behaviors.
	 */
	if (on) {
504 505 506 507 508
		if (desc->wake_depth++ == 0) {
			ret = set_irq_wake_real(irq, on);
			if (ret)
				desc->wake_depth = 0;
			else
509
				irqd_set(&desc->irq_data, IRQD_WAKEUP_STATE);
510
		}
511 512
	} else {
		if (desc->wake_depth == 0) {
513
			WARN(1, "Unbalanced IRQ %d wake disable\n", irq);
514 515 516 517 518
		} else if (--desc->wake_depth == 0) {
			ret = set_irq_wake_real(irq, on);
			if (ret)
				desc->wake_depth = 1;
			else
519
				irqd_clear(&desc->irq_data, IRQD_WAKEUP_STATE);
520
		}
521
	}
522
	irq_put_desc_busunlock(desc, flags);
523 524
	return ret;
}
T
Thomas Gleixner 已提交
525
EXPORT_SYMBOL(irq_set_irq_wake);
526

L
Linus Torvalds 已提交
527 528 529 530 531 532 533
/*
 * Internal function that tells the architecture code whether a
 * particular irq has been exclusively allocated or is available
 * for driver use.
 */
int can_request_irq(unsigned int irq, unsigned long irqflags)
{
534
	unsigned long flags;
535
	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
536
	int canrequest = 0;
L
Linus Torvalds 已提交
537

538 539 540
	if (!desc)
		return 0;

541 542 543 544 545 546 547
	if (irq_settings_can_request(desc)) {
		if (desc->action)
			if (irqflags & desc->action->flags & IRQF_SHARED)
				canrequest =1;
	}
	irq_put_desc_unlock(desc, flags);
	return canrequest;
L
Linus Torvalds 已提交
548 549
}

D
David Brownell 已提交
550
int __irq_set_trigger(struct irq_desc *desc, unsigned int irq,
551
		      unsigned long flags)
552
{
553
	struct irq_chip *chip = desc->irq_data.chip;
554
	int ret, unmask = 0;
555

556
	if (!chip || !chip->irq_set_type) {
557 558 559 560
		/*
		 * IRQF_TRIGGER_* but the PIC does not support multiple
		 * flow-types?
		 */
561
		pr_debug("No set_type function for IRQ %d (%s)\n", irq,
562 563 564 565
				chip ? (chip->name ? : "unknown") : "unknown");
		return 0;
	}

566
	flags &= IRQ_TYPE_SENSE_MASK;
567 568

	if (chip->flags & IRQCHIP_SET_TYPE_MASKED) {
569
		if (!irqd_irq_masked(&desc->irq_data))
570
			mask_irq(desc);
571
		if (!irqd_irq_disabled(&desc->irq_data))
572 573 574
			unmask = 1;
	}

575
	/* caller masked out all except trigger mode flags */
576
	ret = chip->irq_set_type(&desc->irq_data, flags);
577

578 579 580 581 582 583 584 585 586 587 588 589 590 591
	switch (ret) {
	case IRQ_SET_MASK_OK:
		irqd_clear(&desc->irq_data, IRQD_TRIGGER_MASK);
		irqd_set(&desc->irq_data, flags);

	case IRQ_SET_MASK_OK_NOCOPY:
		flags = irqd_get_trigger_type(&desc->irq_data);
		irq_settings_set_trigger_mask(desc, flags);
		irqd_clear(&desc->irq_data, IRQD_LEVEL);
		irq_settings_clr_level(desc);
		if (flags & IRQ_TYPE_LEVEL_MASK) {
			irq_settings_set_level(desc);
			irqd_set(&desc->irq_data, IRQD_LEVEL);
		}
592

593
		ret = 0;
594
		break;
595 596 597
	default:
		pr_err("setting trigger mode %lu for irq %u failed (%pF)\n",
		       flags, irq, chip->irq_set_type);
D
David Brownell 已提交
598
	}
599 600
	if (unmask)
		unmask_irq(desc);
601 602 603
	return ret;
}

T
Thomas Gleixner 已提交
604 605 606 607 608 609 610 611 612 613
/*
 * Default primary interrupt handler for threaded interrupts. Is
 * assigned as primary handler when request_threaded_irq is called
 * with handler == NULL. Useful for oneshot interrupts.
 */
static irqreturn_t irq_default_primary_handler(int irq, void *dev_id)
{
	return IRQ_WAKE_THREAD;
}

614 615 616 617 618 619 620 621 622 623
/*
 * Primary handler for nested threaded interrupts. Should never be
 * called.
 */
static irqreturn_t irq_nested_primary_handler(int irq, void *dev_id)
{
	WARN(1, "Primary handler called for nested irq %d\n", irq);
	return IRQ_NONE;
}

624 625
static int irq_wait_for_interrupt(struct irqaction *action)
{
626 627
	set_current_state(TASK_INTERRUPTIBLE);

628
	while (!kthread_should_stop()) {
629 630 631

		if (test_and_clear_bit(IRQTF_RUNTHREAD,
				       &action->thread_flags)) {
632 633
			__set_current_state(TASK_RUNNING);
			return 0;
634 635
		}
		schedule();
636
		set_current_state(TASK_INTERRUPTIBLE);
637
	}
638
	__set_current_state(TASK_RUNNING);
639 640 641
	return -1;
}

T
Thomas Gleixner 已提交
642 643 644 645 646
/*
 * Oneshot interrupts keep the irq line masked until the threaded
 * handler finished. unmask if the interrupt has not been disabled and
 * is marked MASKED.
 */
647 648
static void irq_finalize_oneshot(struct irq_desc *desc,
				 struct irqaction *action, bool force)
T
Thomas Gleixner 已提交
649
{
650 651
	if (!(desc->istate & IRQS_ONESHOT))
		return;
652
again:
653
	chip_bus_lock(desc);
654
	raw_spin_lock_irq(&desc->lock);
655 656 657 658 659 660 661 662

	/*
	 * Implausible though it may be we need to protect us against
	 * the following scenario:
	 *
	 * The thread is faster done than the hard interrupt handler
	 * on the other CPU. If we unmask the irq line then the
	 * interrupt can come in again and masks the line, leaves due
663
	 * to IRQS_INPROGRESS and the irq line is masked forever.
664 665 666 667 668
	 *
	 * This also serializes the state of shared oneshot handlers
	 * versus "desc->threads_onehsot |= action->thread_mask;" in
	 * irq_wake_thread(). See the comment there which explains the
	 * serialization.
669
	 */
670
	if (unlikely(irqd_irq_inprogress(&desc->irq_data))) {
671
		raw_spin_unlock_irq(&desc->lock);
672
		chip_bus_sync_unlock(desc);
673 674 675 676
		cpu_relax();
		goto again;
	}

677 678 679 680 681 682 683 684 685 686
	/*
	 * Now check again, whether the thread should run. Otherwise
	 * we would clear the threads_oneshot bit of this thread which
	 * was just set.
	 */
	if (!force && test_bit(IRQTF_RUNTHREAD, &action->thread_flags))
		goto out_unlock;

	desc->threads_oneshot &= ~action->thread_mask;

687 688 689 690
	if (!desc->threads_oneshot && !irqd_irq_disabled(&desc->irq_data) &&
	    irqd_irq_masked(&desc->irq_data))
		unmask_irq(desc);

691
out_unlock:
692
	raw_spin_unlock_irq(&desc->lock);
693
	chip_bus_sync_unlock(desc);
T
Thomas Gleixner 已提交
694 695
}

696
#ifdef CONFIG_SMP
697
/*
698
 * Check whether we need to chasnge the affinity of the interrupt thread.
699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716
 */
static void
irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action)
{
	cpumask_var_t mask;

	if (!test_and_clear_bit(IRQTF_AFFINITY, &action->thread_flags))
		return;

	/*
	 * In case we are out of memory we set IRQTF_AFFINITY again and
	 * try again next time
	 */
	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
		set_bit(IRQTF_AFFINITY, &action->thread_flags);
		return;
	}

717
	raw_spin_lock_irq(&desc->lock);
718
	cpumask_copy(mask, desc->irq_data.affinity);
719
	raw_spin_unlock_irq(&desc->lock);
720 721 722 723

	set_cpus_allowed_ptr(current, mask);
	free_cpumask_var(mask);
}
724 725 726 727
#else
static inline void
irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) { }
#endif
728

729 730 731 732 733 734
/*
 * Interrupts which are not explicitely requested as threaded
 * interrupts rely on the implicit bh/preempt disable of the hard irq
 * context. So we need to disable bh here to avoid deadlocks and other
 * side effects.
 */
735
static irqreturn_t
736 737
irq_forced_thread_fn(struct irq_desc *desc, struct irqaction *action)
{
738 739
	irqreturn_t ret;

740
	local_bh_disable();
741
	ret = action->thread_fn(action->irq, action->dev_id);
742 743
	irq_finalize_oneshot(desc, action, false);
	local_bh_enable();
744
	return ret;
745 746 747 748 749 750 751
}

/*
 * Interrupts explicitely requested as threaded interupts want to be
 * preemtible - many of them need to sleep and wait for slow busses to
 * complete.
 */
752 753
static irqreturn_t irq_thread_fn(struct irq_desc *desc,
		struct irqaction *action)
754
{
755 756 757
	irqreturn_t ret;

	ret = action->thread_fn(action->irq, action->dev_id);
758
	irq_finalize_oneshot(desc, action, false);
759
	return ret;
760 761
}

762 763 764 765 766 767 768
static void wake_threads_waitq(struct irq_desc *desc)
{
	if (atomic_dec_and_test(&desc->threads_active) &&
	    waitqueue_active(&desc->wait_for_threads))
		wake_up(&desc->wait_for_threads);
}

769 770 771 772 773
/*
 * Interrupt handler thread
 */
static int irq_thread(void *data)
{
774
	static const struct sched_param param = {
775 776
		.sched_priority = MAX_USER_RT_PRIO/2,
	};
777 778
	struct irqaction *action = data;
	struct irq_desc *desc = irq_to_desc(action->irq);
779 780
	irqreturn_t (*handler_fn)(struct irq_desc *desc,
			struct irqaction *action);
781

782
	if (force_irqthreads && test_bit(IRQTF_FORCED_THREAD,
783 784 785 786 787
					&action->thread_flags))
		handler_fn = irq_forced_thread_fn;
	else
		handler_fn = irq_thread_fn;

788
	sched_setscheduler(current, SCHED_FIFO, &param);
789
	current->irq_thread = 1;
790 791

	while (!irq_wait_for_interrupt(action)) {
792
		irqreturn_t action_ret;
793

794 795
		irq_thread_check_affinity(desc, action);

796 797 798
		action_ret = handler_fn(desc, action);
		if (!noirqdebug)
			note_interrupt(action->irq, desc, action_ret);
799

800
		wake_threads_waitq(desc);
801 802
	}

803 804 805 806 807 808 809 810 811 812 813 814 815
	/*
	 * This is the regular exit path. __free_irq() is stopping the
	 * thread via kthread_stop() after calling
	 * synchronize_irq(). So neither IRQTF_RUNTHREAD nor the
	 * oneshot mask bit should be set.
	 *
	 * Verify that this is true.
	 */
	if (WARN_ON(test_and_clear_bit(IRQTF_RUNTHREAD, &action->thread_flags)))
		wake_threads_waitq(desc);

	if (WARN_ON(desc->threads_oneshot & action->thread_mask))
		irq_finalize_oneshot(desc, action, true);
816

817
	/*
818
	 * Clear irq_thread. Otherwise exit_irq_thread() would make
819 820
	 * fuzz about an active irq thread going into nirvana.
	 */
821
	current->irq_thread = 0;
822 823 824 825 826 827 828 829 830
	return 0;
}

/*
 * Called from do_exit()
 */
void exit_irq_thread(void)
{
	struct task_struct *tsk = current;
831
	struct irq_desc *desc;
832
	struct irqaction *action;
833

834
	if (!tsk->irq_thread)
835 836
		return;

837 838
	action = kthread_data(tsk);

839 840
	printk(KERN_ERR
	       "exiting task \"%s\" (%d) is an active IRQ thread (irq %d)\n",
841
	       tsk->comm ? tsk->comm : "", tsk->pid, action->irq);
842

843
	desc = irq_to_desc(action->irq);
844

845 846 847 848 849 850 851
	/*
	 * If IRQTF_RUNTHREAD is set, we need to decrement
	 * desc->threads_active and wake possible waiters.
	 */
	if (test_and_clear_bit(IRQTF_RUNTHREAD, &action->thread_flags))
		wake_threads_waitq(desc);

852
	/* Prevent a stale desc->threads_oneshot */
853
	irq_finalize_oneshot(desc, action, true);
854 855
}

856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871
static void irq_setup_forced_threading(struct irqaction *new)
{
	if (!force_irqthreads)
		return;
	if (new->flags & (IRQF_NO_THREAD | IRQF_PERCPU | IRQF_ONESHOT))
		return;

	new->flags |= IRQF_ONESHOT;

	if (!new->thread_fn) {
		set_bit(IRQTF_FORCED_THREAD, &new->thread_flags);
		new->thread_fn = new->handler;
		new->handler = irq_default_primary_handler;
	}
}

L
Linus Torvalds 已提交
872 873 874 875
/*
 * Internal function to register an irqaction - typically used to
 * allocate special interrupts that are part of the architecture.
 */
876
static int
I
Ingo Molnar 已提交
877
__setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new)
L
Linus Torvalds 已提交
878
{
879
	struct irqaction *old, **old_ptr;
880
	const char *old_name = NULL;
881
	unsigned long flags, thread_mask = 0;
882 883
	int ret, nested, shared = 0;
	cpumask_var_t mask;
L
Linus Torvalds 已提交
884

885
	if (!desc)
886 887
		return -EINVAL;

888
	if (desc->irq_data.chip == &no_irq_chip)
L
Linus Torvalds 已提交
889
		return -ENOSYS;
890 891
	if (!try_module_get(desc->owner))
		return -ENODEV;
L
Linus Torvalds 已提交
892 893 894 895 896
	/*
	 * Some drivers like serial.c use request_irq() heavily,
	 * so we have to be careful not to interfere with a
	 * running system.
	 */
897
	if (new->flags & IRQF_SAMPLE_RANDOM) {
L
Linus Torvalds 已提交
898 899 900 901 902 903 904 905 906 907 908
		/*
		 * This function might sleep, we want to call it first,
		 * outside of the atomic block.
		 * Yes, this might clear the entropy pool if the wrong
		 * driver is attempted to be loaded, without actually
		 * installing a new handler, but is this really a problem,
		 * only the sysadmin is able to do this.
		 */
		rand_initialize_irq(irq);
	}

909
	/*
910 911 912
	 * Check whether the interrupt nests into another interrupt
	 * thread.
	 */
913
	nested = irq_settings_is_nested_thread(desc);
914
	if (nested) {
915 916 917 918
		if (!new->thread_fn) {
			ret = -EINVAL;
			goto out_mput;
		}
919 920 921 922 923 924
		/*
		 * Replace the primary handler which was provided from
		 * the driver for non nested interrupt handling by the
		 * dummy function which warns when called.
		 */
		new->handler = irq_nested_primary_handler;
925
	} else {
926 927
		if (irq_settings_can_thread(desc))
			irq_setup_forced_threading(new);
928 929
	}

930
	/*
931 932 933
	 * Create a handler thread when a thread function is supplied
	 * and the interrupt does not nest into another interrupt
	 * thread.
934
	 */
935
	if (new->thread_fn && !nested) {
936 937 938 939
		struct task_struct *t;

		t = kthread_create(irq_thread, new, "irq/%d-%s", irq,
				   new->name);
940 941 942 943
		if (IS_ERR(t)) {
			ret = PTR_ERR(t);
			goto out_mput;
		}
944 945 946 947 948 949 950 951 952
		/*
		 * We keep the reference to the task struct even if
		 * the thread dies to avoid that the interrupt code
		 * references an already freed task_struct.
		 */
		get_task_struct(t);
		new->thread = t;
	}

953 954 955 956 957
	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
		ret = -ENOMEM;
		goto out_thread;
	}

L
Linus Torvalds 已提交
958 959 960
	/*
	 * The following block of code has to be executed atomically
	 */
961
	raw_spin_lock_irqsave(&desc->lock, flags);
962 963
	old_ptr = &desc->action;
	old = *old_ptr;
964
	if (old) {
965 966 967
		/*
		 * Can't share interrupts unless both agree to and are
		 * the same type (level, edge, polarity). So both flag
968
		 * fields must have IRQF_SHARED set and the bits which
969 970
		 * set the trigger type must match. Also all must
		 * agree on ONESHOT.
971
		 */
972
		if (!((old->flags & new->flags) & IRQF_SHARED) ||
973 974
		    ((old->flags ^ new->flags) & IRQF_TRIGGER_MASK) ||
		    ((old->flags ^ new->flags) & IRQF_ONESHOT)) {
975
			old_name = old->name;
976
			goto mismatch;
977
		}
978 979

		/* All handlers must agree on per-cpuness */
980 981
		if ((old->flags & IRQF_PERCPU) !=
		    (new->flags & IRQF_PERCPU))
982
			goto mismatch;
L
Linus Torvalds 已提交
983 984 985

		/* add new interrupt at end of irq queue */
		do {
986 987 988 989 990
			/*
			 * Or all existing action->thread_mask bits,
			 * so we can find the next zero bit for this
			 * new action.
			 */
991
			thread_mask |= old->thread_mask;
992 993
			old_ptr = &old->next;
			old = *old_ptr;
L
Linus Torvalds 已提交
994 995 996 997
		} while (old);
		shared = 1;
	}

998
	/*
999 1000 1001
	 * Setup the thread mask for this irqaction for ONESHOT. For
	 * !ONESHOT irqs the thread mask is 0 so we can avoid a
	 * conditional in irq_wake_thread().
1002
	 */
1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032
	if (new->flags & IRQF_ONESHOT) {
		/*
		 * Unlikely to have 32 resp 64 irqs sharing one line,
		 * but who knows.
		 */
		if (thread_mask == ~0UL) {
			ret = -EBUSY;
			goto out_mask;
		}
		/*
		 * The thread_mask for the action is or'ed to
		 * desc->thread_active to indicate that the
		 * IRQF_ONESHOT thread handler has been woken, but not
		 * yet finished. The bit is cleared when a thread
		 * completes. When all threads of a shared interrupt
		 * line have completed desc->threads_active becomes
		 * zero and the interrupt line is unmasked. See
		 * handle.c:irq_wake_thread() for further information.
		 *
		 * If no thread is woken by primary (hard irq context)
		 * interrupt handlers, then desc->threads_active is
		 * also checked for zero to unmask the irq line in the
		 * affected hard irq flow handlers
		 * (handle_[fasteoi|level]_irq).
		 *
		 * The new action gets the first zero bit of
		 * thread_mask assigned. See the loop above which or's
		 * all existing action->thread_mask bits.
		 */
		new->thread_mask = 1 << ffz(thread_mask);
1033 1034
	}

L
Linus Torvalds 已提交
1035
	if (!shared) {
1036 1037
		init_waitqueue_head(&desc->wait_for_threads);

1038
		/* Setup the type (level, edge polarity) if configured: */
1039
		if (new->flags & IRQF_TRIGGER_MASK) {
1040 1041
			ret = __irq_set_trigger(desc, irq,
					new->flags & IRQF_TRIGGER_MASK);
1042

1043
			if (ret)
1044
				goto out_mask;
1045
		}
T
Thomas Gleixner 已提交
1046

1047
		desc->istate &= ~(IRQS_AUTODETECT | IRQS_SPURIOUS_DISABLED | \
1048 1049
				  IRQS_ONESHOT | IRQS_WAITING);
		irqd_clear(&desc->irq_data, IRQD_IRQ_INPROGRESS);
1050

1051 1052 1053 1054
		if (new->flags & IRQF_PERCPU) {
			irqd_set(&desc->irq_data, IRQD_PER_CPU);
			irq_settings_set_per_cpu(desc);
		}
1055

T
Thomas Gleixner 已提交
1056
		if (new->flags & IRQF_ONESHOT)
1057
			desc->istate |= IRQS_ONESHOT;
T
Thomas Gleixner 已提交
1058

1059
		if (irq_settings_can_autoenable(desc))
1060
			irq_startup(desc, true);
1061
		else
1062 1063
			/* Undo nested disables: */
			desc->depth = 1;
1064

1065
		/* Exclude IRQ from balancing if requested */
1066 1067 1068 1069
		if (new->flags & IRQF_NOBALANCING) {
			irq_settings_set_no_balancing(desc);
			irqd_set(&desc->irq_data, IRQD_NO_BALANCING);
		}
1070

1071
		/* Set default affinity mask once everything is setup */
1072
		setup_affinity(irq, desc, mask);
D
David Brownell 已提交
1073

1074 1075 1076 1077 1078 1079 1080 1081
	} else if (new->flags & IRQF_TRIGGER_MASK) {
		unsigned int nmsk = new->flags & IRQF_TRIGGER_MASK;
		unsigned int omsk = irq_settings_get_trigger_mask(desc);

		if (nmsk != omsk)
			/* hope the handler works with current  trigger mode */
			pr_warning("IRQ %d uses trigger mode %u; requested %u\n",
				   irq, nmsk, omsk);
L
Linus Torvalds 已提交
1082
	}
1083

1084
	new->irq = irq;
1085
	*old_ptr = new;
1086

1087 1088 1089
	/* Reset broken irq detection when installing new handler */
	desc->irq_count = 0;
	desc->irqs_unhandled = 0;
1090 1091 1092 1093 1094

	/*
	 * Check whether we disabled the irq via the spurious handler
	 * before. Reenable it and give it another chance.
	 */
1095 1096
	if (shared && (desc->istate & IRQS_SPURIOUS_DISABLED)) {
		desc->istate &= ~IRQS_SPURIOUS_DISABLED;
1097
		__enable_irq(desc, irq, false);
1098 1099
	}

1100
	raw_spin_unlock_irqrestore(&desc->lock, flags);
L
Linus Torvalds 已提交
1101

1102 1103 1104 1105 1106 1107 1108
	/*
	 * Strictly no need to wake it up, but hung_task complains
	 * when no hard interrupt wakes the thread up.
	 */
	if (new->thread)
		wake_up_process(new->thread);

1109
	register_irq_proc(irq, desc);
L
Linus Torvalds 已提交
1110 1111
	new->dir = NULL;
	register_handler_proc(irq, new);
1112
	free_cpumask_var(mask);
L
Linus Torvalds 已提交
1113 1114

	return 0;
1115 1116

mismatch:
1117
#ifdef CONFIG_DEBUG_SHIRQ
1118
	if (!(new->flags & IRQF_PROBE_SHARED)) {
1119
		printk(KERN_ERR "IRQ handler type mismatch for IRQ %d\n", irq);
1120 1121
		if (old_name)
			printk(KERN_ERR "current handler: %s\n", old_name);
1122 1123
		dump_stack();
	}
1124
#endif
1125 1126
	ret = -EBUSY;

1127
out_mask:
1128
	raw_spin_unlock_irqrestore(&desc->lock, flags);
1129 1130
	free_cpumask_var(mask);

1131 1132 1133 1134 1135
out_thread:
	if (new->thread) {
		struct task_struct *t = new->thread;

		new->thread = NULL;
1136
		kthread_stop(t);
1137 1138
		put_task_struct(t);
	}
1139 1140
out_mput:
	module_put(desc->owner);
1141
	return ret;
L
Linus Torvalds 已提交
1142 1143
}

1144 1145 1146 1147 1148 1149 1150 1151 1152
/**
 *	setup_irq - setup an interrupt
 *	@irq: Interrupt line to setup
 *	@act: irqaction for the interrupt
 *
 * Used to statically setup interrupts in the early boot process.
 */
int setup_irq(unsigned int irq, struct irqaction *act)
{
1153
	int retval;
1154 1155
	struct irq_desc *desc = irq_to_desc(irq);

1156 1157
	if (WARN_ON(irq_settings_is_per_cpu_devid(desc)))
		return -EINVAL;
1158 1159 1160 1161 1162
	chip_bus_lock(desc);
	retval = __setup_irq(irq, desc, act);
	chip_bus_sync_unlock(desc);

	return retval;
1163
}
1164
EXPORT_SYMBOL_GPL(setup_irq);
1165

1166
/*
1167 1168
 * Internal function to unregister an irqaction - used to free
 * regular and special interrupts that are part of the architecture.
L
Linus Torvalds 已提交
1169
 */
1170
static struct irqaction *__free_irq(unsigned int irq, void *dev_id)
L
Linus Torvalds 已提交
1171
{
1172
	struct irq_desc *desc = irq_to_desc(irq);
1173
	struct irqaction *action, **action_ptr;
L
Linus Torvalds 已提交
1174 1175
	unsigned long flags;

1176
	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
1177 1178

	if (!desc)
1179
		return NULL;
L
Linus Torvalds 已提交
1180

1181
	raw_spin_lock_irqsave(&desc->lock, flags);
1182 1183 1184 1185 1186

	/*
	 * There can be multiple actions per IRQ descriptor, find the right
	 * one based on the dev_id:
	 */
1187
	action_ptr = &desc->action;
L
Linus Torvalds 已提交
1188
	for (;;) {
1189
		action = *action_ptr;
L
Linus Torvalds 已提交
1190

1191 1192
		if (!action) {
			WARN(1, "Trying to free already-free IRQ %d\n", irq);
1193
			raw_spin_unlock_irqrestore(&desc->lock, flags);
L
Linus Torvalds 已提交
1194

1195
			return NULL;
1196
		}
L
Linus Torvalds 已提交
1197

1198 1199
		if (action->dev_id == dev_id)
			break;
1200
		action_ptr = &action->next;
1201
	}
1202

1203
	/* Found it - now remove it from the list of entries: */
1204
	*action_ptr = action->next;
1205 1206

	/* Currently used only by UML, might disappear one day: */
1207
#ifdef CONFIG_IRQ_RELEASE_METHOD
1208 1209
	if (desc->irq_data.chip->release)
		desc->irq_data.chip->release(irq, dev_id);
1210
#endif
1211

1212
	/* If this was the last handler, shut down the IRQ line: */
1213 1214
	if (!desc->action)
		irq_shutdown(desc);
1215

1216 1217 1218 1219 1220 1221
#ifdef CONFIG_SMP
	/* make sure affinity_hint is cleaned up */
	if (WARN_ON_ONCE(desc->affinity_hint))
		desc->affinity_hint = NULL;
#endif

1222
	raw_spin_unlock_irqrestore(&desc->lock, flags);
1223 1224 1225 1226 1227

	unregister_handler_proc(irq, action);

	/* Make sure it's not being used on another CPU: */
	synchronize_irq(irq);
L
Linus Torvalds 已提交
1228

1229
#ifdef CONFIG_DEBUG_SHIRQ
1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241
	/*
	 * It's a shared IRQ -- the driver ought to be prepared for an IRQ
	 * event to happen even now it's being freed, so let's make sure that
	 * is so by doing an extra call to the handler ....
	 *
	 * ( We do this after actually deregistering it, to make sure that a
	 *   'real' IRQ doesn't run in * parallel with our fake. )
	 */
	if (action->flags & IRQF_SHARED) {
		local_irq_save(flags);
		action->handler(irq, dev_id);
		local_irq_restore(flags);
L
Linus Torvalds 已提交
1242
	}
1243
#endif
1244 1245

	if (action->thread) {
1246
		kthread_stop(action->thread);
1247 1248 1249
		put_task_struct(action->thread);
	}

1250
	module_put(desc->owner);
1251 1252 1253
	return action;
}

1254 1255 1256 1257 1258 1259 1260 1261 1262
/**
 *	remove_irq - free an interrupt
 *	@irq: Interrupt line to free
 *	@act: irqaction for the interrupt
 *
 * Used to remove interrupts statically setup by the early boot process.
 */
void remove_irq(unsigned int irq, struct irqaction *act)
{
1263 1264 1265 1266
	struct irq_desc *desc = irq_to_desc(irq);

	if (desc && !WARN_ON(irq_settings_is_per_cpu_devid(desc)))
	    __free_irq(irq, act->dev_id);
1267
}
1268
EXPORT_SYMBOL_GPL(remove_irq);
1269

1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285
/**
 *	free_irq - free an interrupt allocated with request_irq
 *	@irq: Interrupt line to free
 *	@dev_id: Device identity to free
 *
 *	Remove an interrupt handler. The handler is removed and if the
 *	interrupt line is no longer in use by any driver it is disabled.
 *	On a shared IRQ the caller must ensure the interrupt is disabled
 *	on the card it drives before calling this function. The function
 *	does not return until any executing interrupts for this IRQ
 *	have completed.
 *
 *	This function must not be called from interrupt context.
 */
void free_irq(unsigned int irq, void *dev_id)
{
T
Thomas Gleixner 已提交
1286 1287
	struct irq_desc *desc = irq_to_desc(irq);

1288
	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
T
Thomas Gleixner 已提交
1289 1290
		return;

1291 1292 1293 1294 1295
#ifdef CONFIG_SMP
	if (WARN_ON(desc->affinity_notify))
		desc->affinity_notify = NULL;
#endif

1296
	chip_bus_lock(desc);
1297
	kfree(__free_irq(irq, dev_id));
1298
	chip_bus_sync_unlock(desc);
L
Linus Torvalds 已提交
1299 1300 1301 1302
}
EXPORT_SYMBOL(free_irq);

/**
1303
 *	request_threaded_irq - allocate an interrupt line
L
Linus Torvalds 已提交
1304
 *	@irq: Interrupt line to allocate
1305 1306
 *	@handler: Function to be called when the IRQ occurs.
 *		  Primary handler for threaded interrupts
T
Thomas Gleixner 已提交
1307 1308
 *		  If NULL and thread_fn != NULL the default
 *		  primary handler is installed
1309 1310
 *	@thread_fn: Function called from the irq handler thread
 *		    If NULL, no irq thread is created
L
Linus Torvalds 已提交
1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321
 *	@irqflags: Interrupt type flags
 *	@devname: An ascii name for the claiming device
 *	@dev_id: A cookie passed back to the handler function
 *
 *	This call allocates interrupt resources and enables the
 *	interrupt line and IRQ handling. From the point this
 *	call is made your handler function may be invoked. Since
 *	your handler function must clear any interrupt the board
 *	raises, you must take care both to initialise your hardware
 *	and to set up the interrupt handler in the right order.
 *
1322
 *	If you want to set up a threaded irq handler for your device
J
Javi Merino 已提交
1323
 *	then you need to supply @handler and @thread_fn. @handler is
1324 1325 1326
 *	still called in hard interrupt context and has to check
 *	whether the interrupt originates from the device. If yes it
 *	needs to disable the interrupt on the device and return
1327
 *	IRQ_WAKE_THREAD which will wake up the handler thread and run
1328 1329 1330
 *	@thread_fn. This split handler design is necessary to support
 *	shared interrupts.
 *
L
Linus Torvalds 已提交
1331 1332 1333 1334 1335 1336 1337 1338 1339
 *	Dev_id must be globally unique. Normally the address of the
 *	device data structure is used as the cookie. Since the handler
 *	receives this value it makes sense to use it.
 *
 *	If your interrupt is shared you must pass a non NULL dev_id
 *	as this is required when freeing the interrupt.
 *
 *	Flags:
 *
1340 1341
 *	IRQF_SHARED		Interrupt is shared
 *	IRQF_SAMPLE_RANDOM	The interrupt can be used for entropy
D
David Brownell 已提交
1342
 *	IRQF_TRIGGER_*		Specify active edge(s) or level
L
Linus Torvalds 已提交
1343 1344
 *
 */
1345 1346 1347
int request_threaded_irq(unsigned int irq, irq_handler_t handler,
			 irq_handler_t thread_fn, unsigned long irqflags,
			 const char *devname, void *dev_id)
L
Linus Torvalds 已提交
1348
{
1349
	struct irqaction *action;
1350
	struct irq_desc *desc;
1351
	int retval;
L
Linus Torvalds 已提交
1352 1353 1354 1355 1356 1357 1358

	/*
	 * Sanity-check: shared interrupts must pass in a real dev-ID,
	 * otherwise we'll have trouble later trying to figure out
	 * which interrupt is which (messes up the interrupt freeing
	 * logic etc).
	 */
1359
	if ((irqflags & IRQF_SHARED) && !dev_id)
L
Linus Torvalds 已提交
1360
		return -EINVAL;
1361

1362
	desc = irq_to_desc(irq);
1363
	if (!desc)
L
Linus Torvalds 已提交
1364
		return -EINVAL;
1365

1366 1367
	if (!irq_settings_can_request(desc) ||
	    WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1368
		return -EINVAL;
T
Thomas Gleixner 已提交
1369 1370 1371 1372 1373 1374

	if (!handler) {
		if (!thread_fn)
			return -EINVAL;
		handler = irq_default_primary_handler;
	}
L
Linus Torvalds 已提交
1375

1376
	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
L
Linus Torvalds 已提交
1377 1378 1379 1380
	if (!action)
		return -ENOMEM;

	action->handler = handler;
1381
	action->thread_fn = thread_fn;
L
Linus Torvalds 已提交
1382 1383 1384 1385
	action->flags = irqflags;
	action->name = devname;
	action->dev_id = dev_id;

1386
	chip_bus_lock(desc);
1387
	retval = __setup_irq(irq, desc, action);
1388
	chip_bus_sync_unlock(desc);
T
Thomas Gleixner 已提交
1389

1390 1391 1392
	if (retval)
		kfree(action);

1393
#ifdef CONFIG_DEBUG_SHIRQ_FIXME
1394
	if (!retval && (irqflags & IRQF_SHARED)) {
D
David Woodhouse 已提交
1395 1396 1397
		/*
		 * It's a shared IRQ -- the driver ought to be prepared for it
		 * to happen immediately, so let's make sure....
1398 1399
		 * We disable the irq to make sure that a 'real' IRQ doesn't
		 * run in parallel with our fake.
D
David Woodhouse 已提交
1400
		 */
1401
		unsigned long flags;
D
David Woodhouse 已提交
1402

1403
		disable_irq(irq);
1404
		local_irq_save(flags);
1405

1406
		handler(irq, dev_id);
1407

1408
		local_irq_restore(flags);
1409
		enable_irq(irq);
D
David Woodhouse 已提交
1410 1411
	}
#endif
L
Linus Torvalds 已提交
1412 1413
	return retval;
}
1414
EXPORT_SYMBOL(request_threaded_irq);
1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441

/**
 *	request_any_context_irq - allocate an interrupt line
 *	@irq: Interrupt line to allocate
 *	@handler: Function to be called when the IRQ occurs.
 *		  Threaded handler for threaded interrupts.
 *	@flags: Interrupt type flags
 *	@name: An ascii name for the claiming device
 *	@dev_id: A cookie passed back to the handler function
 *
 *	This call allocates interrupt resources and enables the
 *	interrupt line and IRQ handling. It selects either a
 *	hardirq or threaded handling method depending on the
 *	context.
 *
 *	On failure, it returns a negative value. On success,
 *	it returns either IRQC_IS_HARDIRQ or IRQC_IS_NESTED.
 */
int request_any_context_irq(unsigned int irq, irq_handler_t handler,
			    unsigned long flags, const char *name, void *dev_id)
{
	struct irq_desc *desc = irq_to_desc(irq);
	int ret;

	if (!desc)
		return -EINVAL;

1442
	if (irq_settings_is_nested_thread(desc)) {
1443 1444 1445 1446 1447 1448 1449 1450 1451
		ret = request_threaded_irq(irq, NULL, handler,
					   flags, name, dev_id);
		return !ret ? IRQC_IS_NESTED : ret;
	}

	ret = request_irq(irq, handler, flags, name, dev_id);
	return !ret ? IRQC_IS_HARDIRQ : ret;
}
EXPORT_SYMBOL_GPL(request_any_context_irq);
1452

1453
void enable_percpu_irq(unsigned int irq, unsigned int type)
1454 1455 1456 1457 1458 1459 1460 1461
{
	unsigned int cpu = smp_processor_id();
	unsigned long flags;
	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);

	if (!desc)
		return;

1462 1463 1464 1465 1466 1467 1468
	type &= IRQ_TYPE_SENSE_MASK;
	if (type != IRQ_TYPE_NONE) {
		int ret;

		ret = __irq_set_trigger(desc, irq, type);

		if (ret) {
1469
			WARN(1, "failed to set type for IRQ%d\n", irq);
1470 1471 1472 1473
			goto out;
		}
	}

1474
	irq_percpu_enable(desc, cpu);
1475
out:
1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629
	irq_put_desc_unlock(desc, flags);
}

void disable_percpu_irq(unsigned int irq)
{
	unsigned int cpu = smp_processor_id();
	unsigned long flags;
	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);

	if (!desc)
		return;

	irq_percpu_disable(desc, cpu);
	irq_put_desc_unlock(desc, flags);
}

/*
 * Internal function to unregister a percpu irqaction.
 */
static struct irqaction *__free_percpu_irq(unsigned int irq, void __percpu *dev_id)
{
	struct irq_desc *desc = irq_to_desc(irq);
	struct irqaction *action;
	unsigned long flags;

	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);

	if (!desc)
		return NULL;

	raw_spin_lock_irqsave(&desc->lock, flags);

	action = desc->action;
	if (!action || action->percpu_dev_id != dev_id) {
		WARN(1, "Trying to free already-free IRQ %d\n", irq);
		goto bad;
	}

	if (!cpumask_empty(desc->percpu_enabled)) {
		WARN(1, "percpu IRQ %d still enabled on CPU%d!\n",
		     irq, cpumask_first(desc->percpu_enabled));
		goto bad;
	}

	/* Found it - now remove it from the list of entries: */
	desc->action = NULL;

	raw_spin_unlock_irqrestore(&desc->lock, flags);

	unregister_handler_proc(irq, action);

	module_put(desc->owner);
	return action;

bad:
	raw_spin_unlock_irqrestore(&desc->lock, flags);
	return NULL;
}

/**
 *	remove_percpu_irq - free a per-cpu interrupt
 *	@irq: Interrupt line to free
 *	@act: irqaction for the interrupt
 *
 * Used to remove interrupts statically setup by the early boot process.
 */
void remove_percpu_irq(unsigned int irq, struct irqaction *act)
{
	struct irq_desc *desc = irq_to_desc(irq);

	if (desc && irq_settings_is_per_cpu_devid(desc))
	    __free_percpu_irq(irq, act->percpu_dev_id);
}

/**
 *	free_percpu_irq - free an interrupt allocated with request_percpu_irq
 *	@irq: Interrupt line to free
 *	@dev_id: Device identity to free
 *
 *	Remove a percpu interrupt handler. The handler is removed, but
 *	the interrupt line is not disabled. This must be done on each
 *	CPU before calling this function. The function does not return
 *	until any executing interrupts for this IRQ have completed.
 *
 *	This function must not be called from interrupt context.
 */
void free_percpu_irq(unsigned int irq, void __percpu *dev_id)
{
	struct irq_desc *desc = irq_to_desc(irq);

	if (!desc || !irq_settings_is_per_cpu_devid(desc))
		return;

	chip_bus_lock(desc);
	kfree(__free_percpu_irq(irq, dev_id));
	chip_bus_sync_unlock(desc);
}

/**
 *	setup_percpu_irq - setup a per-cpu interrupt
 *	@irq: Interrupt line to setup
 *	@act: irqaction for the interrupt
 *
 * Used to statically setup per-cpu interrupts in the early boot process.
 */
int setup_percpu_irq(unsigned int irq, struct irqaction *act)
{
	struct irq_desc *desc = irq_to_desc(irq);
	int retval;

	if (!desc || !irq_settings_is_per_cpu_devid(desc))
		return -EINVAL;
	chip_bus_lock(desc);
	retval = __setup_irq(irq, desc, act);
	chip_bus_sync_unlock(desc);

	return retval;
}

/**
 *	request_percpu_irq - allocate a percpu interrupt line
 *	@irq: Interrupt line to allocate
 *	@handler: Function to be called when the IRQ occurs.
 *	@devname: An ascii name for the claiming device
 *	@dev_id: A percpu cookie passed back to the handler function
 *
 *	This call allocates interrupt resources, but doesn't
 *	automatically enable the interrupt. It has to be done on each
 *	CPU using enable_percpu_irq().
 *
 *	Dev_id must be globally unique. It is a per-cpu variable, and
 *	the handler gets called with the interrupted CPU's instance of
 *	that variable.
 */
int request_percpu_irq(unsigned int irq, irq_handler_t handler,
		       const char *devname, void __percpu *dev_id)
{
	struct irqaction *action;
	struct irq_desc *desc;
	int retval;

	if (!dev_id)
		return -EINVAL;

	desc = irq_to_desc(irq);
	if (!desc || !irq_settings_can_request(desc) ||
	    !irq_settings_is_per_cpu_devid(desc))
		return -EINVAL;

	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
	if (!action)
		return -ENOMEM;

	action->handler = handler;
1630
	action->flags = IRQF_PERCPU | IRQF_NO_SUSPEND;
1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642
	action->name = devname;
	action->percpu_dev_id = dev_id;

	chip_bus_lock(desc);
	retval = __setup_irq(irq, desc, action);
	chip_bus_sync_unlock(desc);

	if (retval)
		kfree(action);

	return retval;
}