irqdomain.c 46.7 KB
Newer Older
1 2
#define pr_fmt(fmt)  "irq: " fmt

3 4 5
#include <linux/debugfs.h>
#include <linux/hardirq.h>
#include <linux/interrupt.h>
6
#include <linux/irq.h>
7
#include <linux/irqdesc.h>
8 9 10 11
#include <linux/irqdomain.h>
#include <linux/module.h>
#include <linux/mutex.h>
#include <linux/of.h>
12
#include <linux/of_address.h>
13
#include <linux/of_irq.h>
P
Paul Mundt 已提交
14
#include <linux/topology.h>
15
#include <linux/seq_file.h>
16
#include <linux/slab.h>
17 18
#include <linux/smp.h>
#include <linux/fs.h>
19 20 21 22

static LIST_HEAD(irq_domain_list);
static DEFINE_MUTEX(irq_domain_mutex);

23
static DEFINE_MUTEX(revmap_trees_mutex);
24
static struct irq_domain *irq_default_domain;
25

26 27
static void irq_domain_check_hierarchy(struct irq_domain *domain);

28
struct irqchip_fwid {
29 30 31
	struct fwnode_handle	fwnode;
	unsigned int		type;
	char			*name;
32
	void *data;
33 34
};

35 36 37 38 39 40 41 42
#ifdef CONFIG_GENERIC_IRQ_DEBUGFS
static void debugfs_add_domain_dir(struct irq_domain *d);
static void debugfs_remove_domain_dir(struct irq_domain *d);
#else
static inline void debugfs_add_domain_dir(struct irq_domain *d) { }
static inline void debugfs_remove_domain_dir(struct irq_domain *d) { }
#endif

43 44 45
/**
 * irq_domain_alloc_fwnode - Allocate a fwnode_handle suitable for
 *                           identifying an irq domain
46 47 48 49
 * @type:	Type of irqchip_fwnode. See linux/irqdomain.h
 * @name:	Optional user provided domain name
 * @id:		Optional user provided id if name != NULL
 * @data:	Optional user-provided data
50
 *
51
 * Allocate a struct irqchip_fwid, and return a poiner to the embedded
52
 * fwnode_handle (or NULL on failure).
53 54 55 56 57
 *
 * Note: The types IRQCHIP_FWNODE_NAMED and IRQCHIP_FWNODE_NAMED_ID are
 * solely to transport name information to irqdomain creation code. The
 * node is not stored. For other types the pointer is kept in the irq
 * domain struct.
58
 */
59 60
struct fwnode_handle *__irq_domain_alloc_fwnode(unsigned int type, int id,
						const char *name, void *data)
61 62
{
	struct irqchip_fwid *fwid;
63
	char *n;
64 65 66

	fwid = kzalloc(sizeof(*fwid), GFP_KERNEL);

67 68 69 70 71 72 73 74 75 76 77 78 79
	switch (type) {
	case IRQCHIP_FWNODE_NAMED:
		n = kasprintf(GFP_KERNEL, "%s", name);
		break;
	case IRQCHIP_FWNODE_NAMED_ID:
		n = kasprintf(GFP_KERNEL, "%s-%d", name, id);
		break;
	default:
		n = kasprintf(GFP_KERNEL, "irqchip@%p", data);
		break;
	}

	if (!fwid || !n) {
80
		kfree(fwid);
81
		kfree(n);
82 83 84
		return NULL;
	}

85 86
	fwid->type = type;
	fwid->name = n;
87 88 89 90
	fwid->data = data;
	fwid->fwnode.type = FWNODE_IRQCHIP;
	return &fwid->fwnode;
}
91
EXPORT_SYMBOL_GPL(__irq_domain_alloc_fwnode);
92 93 94 95 96 97 98 99 100 101

/**
 * irq_domain_free_fwnode - Free a non-OF-backed fwnode_handle
 *
 * Free a fwnode_handle allocated with irq_domain_alloc_fwnode.
 */
void irq_domain_free_fwnode(struct fwnode_handle *fwnode)
{
	struct irqchip_fwid *fwid;

102
	if (WARN_ON(!is_fwnode_irqchip(fwnode)))
103 104 105 106 107 108
		return;

	fwid = container_of(fwnode, struct irqchip_fwid, fwnode);
	kfree(fwid->name);
	kfree(fwid);
}
109
EXPORT_SYMBOL_GPL(irq_domain_free_fwnode);
110

111
/**
112
 * __irq_domain_add() - Allocate a new irq_domain data structure
113
 * @fwnode: firmware node for the interrupt controller
114
 * @size: Size of linear map; 0 for radix mapping only
115
 * @hwirq_max: Maximum number of interrupts supported by controller
116 117
 * @direct_max: Maximum value of direct maps; Use ~0 for no limit; 0 for no
 *              direct mapping
118
 * @ops: domain callbacks
119
 * @host_data: Controller private data pointer
120
 *
121 122
 * Allocates and initialize and irq_domain structure.
 * Returns pointer to IRQ domain, or NULL on failure.
123
 */
124
struct irq_domain *__irq_domain_add(struct fwnode_handle *fwnode, int size,
125
				    irq_hw_number_t hwirq_max, int direct_max,
126 127
				    const struct irq_domain_ops *ops,
				    void *host_data)
128
{
129
	struct device_node *of_node = to_of_node(fwnode);
130
	struct irqchip_fwid *fwid;
131
	struct irq_domain *domain;
132

133 134
	static atomic_t unknown_domains;

135 136
	domain = kzalloc_node(sizeof(*domain) + (sizeof(unsigned int) * size),
			      GFP_KERNEL, of_node_to_nid(of_node));
137
	if (WARN_ON(!domain))
138 139
		return NULL;

140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192
	if (fwnode && is_fwnode_irqchip(fwnode)) {
		fwid = container_of(fwnode, struct irqchip_fwid, fwnode);

		switch (fwid->type) {
		case IRQCHIP_FWNODE_NAMED:
		case IRQCHIP_FWNODE_NAMED_ID:
			domain->name = kstrdup(fwid->name, GFP_KERNEL);
			if (!domain->name) {
				kfree(domain);
				return NULL;
			}
			domain->flags |= IRQ_DOMAIN_NAME_ALLOCATED;
			break;
		default:
			domain->fwnode = fwnode;
			domain->name = fwid->name;
			break;
		}
	} else if (of_node) {
		char *name;

		/*
		 * DT paths contain '/', which debugfs is legitimately
		 * unhappy about. Replace them with ':', which does
		 * the trick and is not as offensive as '\'...
		 */
		name = kstrdup(of_node_full_name(of_node), GFP_KERNEL);
		if (!name) {
			kfree(domain);
			return NULL;
		}

		strreplace(name, '/', ':');

		domain->name = name;
		domain->fwnode = fwnode;
		domain->flags |= IRQ_DOMAIN_NAME_ALLOCATED;
	}

	if (!domain->name) {
		if (fwnode) {
			pr_err("Invalid fwnode type (%d) for irqdomain\n",
			       fwnode->type);
		}
		domain->name = kasprintf(GFP_KERNEL, "unknown-%d",
					 atomic_inc_return(&unknown_domains));
		if (!domain->name) {
			kfree(domain);
			return NULL;
		}
		domain->flags |= IRQ_DOMAIN_NAME_ALLOCATED;
	}

193 194
	of_node_get(of_node);

195
	/* Fill structure */
G
Grant Likely 已提交
196
	INIT_RADIX_TREE(&domain->revmap_tree, GFP_KERNEL);
197
	domain->ops = ops;
198
	domain->host_data = host_data;
199
	domain->hwirq_max = hwirq_max;
G
Grant Likely 已提交
200
	domain->revmap_size = size;
201
	domain->revmap_direct_max_irq = direct_max;
202
	irq_domain_check_hierarchy(domain);
203

204
	mutex_lock(&irq_domain_mutex);
205
	debugfs_add_domain_dir(domain);
206 207
	list_add(&domain->link, &irq_domain_list);
	mutex_unlock(&irq_domain_mutex);
208

G
Grant Likely 已提交
209
	pr_debug("Added domain %s\n", domain->name);
210
	return domain;
211
}
212
EXPORT_SYMBOL_GPL(__irq_domain_add);
213

214 215 216 217 218 219 220 221 222 223 224
/**
 * irq_domain_remove() - Remove an irq domain.
 * @domain: domain to remove
 *
 * This routine is used to remove an irq domain. The caller must ensure
 * that all mappings within the domain have been disposed of prior to
 * use, depending on the revmap type.
 */
void irq_domain_remove(struct irq_domain *domain)
{
	mutex_lock(&irq_domain_mutex);
225
	debugfs_remove_domain_dir(domain);
226

227
	WARN_ON(!radix_tree_empty(&domain->revmap_tree));
228 229 230 231 232 233 234 235 236 237 238

	list_del(&domain->link);

	/*
	 * If the going away domain is the default one, reset it.
	 */
	if (unlikely(irq_default_domain == domain))
		irq_set_default_host(NULL);

	mutex_unlock(&irq_domain_mutex);

G
Grant Likely 已提交
239
	pr_debug("Removed domain %s\n", domain->name);
240

241
	of_node_put(irq_domain_get_of_node(domain));
242 243
	if (domain->flags & IRQ_DOMAIN_NAME_ALLOCATED)
		kfree(domain->name);
244
	kfree(domain);
245
}
246
EXPORT_SYMBOL_GPL(irq_domain_remove);
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 276 277 278
void irq_domain_update_bus_token(struct irq_domain *domain,
				 enum irq_domain_bus_token bus_token)
{
	char *name;

	if (domain->bus_token == bus_token)
		return;

	mutex_lock(&irq_domain_mutex);

	domain->bus_token = bus_token;

	name = kasprintf(GFP_KERNEL, "%s-%d", domain->name, bus_token);
	if (!name) {
		mutex_unlock(&irq_domain_mutex);
		return;
	}

	debugfs_remove_domain_dir(domain);

	if (domain->flags & IRQ_DOMAIN_NAME_ALLOCATED)
		kfree(domain->name);
	else
		domain->flags |= IRQ_DOMAIN_NAME_ALLOCATED;

	domain->name = name;
	debugfs_add_domain_dir(domain);

	mutex_unlock(&irq_domain_mutex);
}

279
/**
280
 * irq_domain_add_simple() - Register an irq_domain and optionally map a range of irqs
281 282
 * @of_node: pointer to interrupt controller's device tree node.
 * @size: total number of irqs in mapping
283
 * @first_irq: first number of irq block assigned to the domain,
284 285
 *	pass zero to assign irqs on-the-fly. If first_irq is non-zero, then
 *	pre-map all of the irqs in the domain to virqs starting at first_irq.
286
 * @ops: domain callbacks
287 288
 * @host_data: Controller private data pointer
 *
289 290
 * Allocates an irq_domain, and optionally if first_irq is positive then also
 * allocate irq_descs and map all of the hwirqs to virqs starting at first_irq.
291 292
 *
 * This is intended to implement the expected behaviour for most
293 294 295
 * interrupt controllers. If device tree is used, then first_irq will be 0 and
 * irqs get mapped dynamically on the fly. However, if the controller requires
 * static virq assignments (non-DT boot) then it will set that up correctly.
296 297 298 299 300 301 302
 */
struct irq_domain *irq_domain_add_simple(struct device_node *of_node,
					 unsigned int size,
					 unsigned int first_irq,
					 const struct irq_domain_ops *ops,
					 void *host_data)
{
303 304
	struct irq_domain *domain;

305
	domain = __irq_domain_add(of_node_to_fwnode(of_node), size, size, 0, ops, host_data);
306 307
	if (!domain)
		return NULL;
308

309
	if (first_irq > 0) {
310
		if (IS_ENABLED(CONFIG_SPARSE_IRQ)) {
311 312 313 314
			/* attempt to allocated irq_descs */
			int rc = irq_alloc_descs(first_irq, first_irq, size,
						 of_node_to_nid(of_node));
			if (rc < 0)
315 316
				pr_info("Cannot allocate irq_descs @ IRQ%d, assuming pre-allocated\n",
					first_irq);
317
		}
318
		irq_domain_associate_many(domain, first_irq, 0, size);
319 320
	}

321
	return domain;
322
}
323
EXPORT_SYMBOL_GPL(irq_domain_add_simple);
324

325 326 327
/**
 * irq_domain_add_legacy() - Allocate and register a legacy revmap irq_domain.
 * @of_node: pointer to interrupt controller's device tree node.
328 329 330 331 332
 * @size: total number of irqs in legacy mapping
 * @first_irq: first number of irq block assigned to the domain
 * @first_hwirq: first hwirq number to use for the translation. Should normally
 *               be '0', but a positive integer can be used if the effective
 *               hwirqs numbering does not begin at zero.
333 334 335 336 337 338 339 340
 * @ops: map/unmap domain callbacks
 * @host_data: Controller private data pointer
 *
 * Note: the map() callback will be called before this function returns
 * for all legacy interrupts except 0 (which is always the invalid irq for
 * a legacy controller).
 */
struct irq_domain *irq_domain_add_legacy(struct device_node *of_node,
341 342 343
					 unsigned int size,
					 unsigned int first_irq,
					 irq_hw_number_t first_hwirq,
344
					 const struct irq_domain_ops *ops,
345 346
					 void *host_data)
{
347
	struct irq_domain *domain;
348

349
	domain = __irq_domain_add(of_node_to_fwnode(of_node), first_hwirq + size,
350
				  first_hwirq + size, 0, ops, host_data);
351 352
	if (domain)
		irq_domain_associate_many(domain, first_irq, first_hwirq, size);
353

354 355
	return domain;
}
356
EXPORT_SYMBOL_GPL(irq_domain_add_legacy);
357

358
/**
359 360
 * irq_find_matching_fwspec() - Locates a domain for a given fwspec
 * @fwspec: FW specifier for an interrupt
361
 * @bus_token: domain-specific data
362
 */
363
struct irq_domain *irq_find_matching_fwspec(struct irq_fwspec *fwspec,
364
					    enum irq_domain_bus_token bus_token)
365 366
{
	struct irq_domain *h, *found = NULL;
367
	struct fwnode_handle *fwnode = fwspec->fwnode;
368
	int rc;
369 370 371 372 373

	/* We might want to match the legacy controller last since
	 * it might potentially be set to match all interrupts in
	 * the absence of a device node. This isn't a problem so far
	 * yet though...
374 375 376 377
	 *
	 * bus_token == DOMAIN_BUS_ANY matches any domain, any other
	 * values must generate an exact match for the domain to be
	 * selected.
378 379
	 */
	mutex_lock(&irq_domain_mutex);
380
	list_for_each_entry(h, &irq_domain_list, link) {
381 382 383
		if (h->ops->select && fwspec->param_count)
			rc = h->ops->select(h, fwspec, bus_token);
		else if (h->ops->match)
384
			rc = h->ops->match(h, to_of_node(fwnode), bus_token);
385
		else
386
			rc = ((fwnode != NULL) && (h->fwnode == fwnode) &&
387 388
			      ((bus_token == DOMAIN_BUS_ANY) ||
			       (h->bus_token == bus_token)));
389 390

		if (rc) {
391 392 393
			found = h;
			break;
		}
394
	}
395 396 397
	mutex_unlock(&irq_domain_mutex);
	return found;
}
398
EXPORT_SYMBOL_GPL(irq_find_matching_fwspec);
399

400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424
/**
 * irq_domain_check_msi_remap - Check whether all MSI irq domains implement
 * IRQ remapping
 *
 * Return: false if any MSI irq domain does not support IRQ remapping,
 * true otherwise (including if there is no MSI irq domain)
 */
bool irq_domain_check_msi_remap(void)
{
	struct irq_domain *h;
	bool ret = true;

	mutex_lock(&irq_domain_mutex);
	list_for_each_entry(h, &irq_domain_list, link) {
		if (irq_domain_is_msi(h) &&
		    !irq_domain_hierarchical_is_msi_remap(h)) {
			ret = false;
			break;
		}
	}
	mutex_unlock(&irq_domain_mutex);
	return ret;
}
EXPORT_SYMBOL_GPL(irq_domain_check_msi_remap);

425 426
/**
 * irq_set_default_host() - Set a "default" irq domain
427
 * @domain: default domain pointer
428 429 430 431 432 433
 *
 * For convenience, it's possible to set a "default" domain that will be used
 * whenever NULL is passed to irq_create_mapping(). It makes life easier for
 * platforms that want to manipulate a few hard coded interrupt numbers that
 * aren't properly represented in the device-tree.
 */
434
void irq_set_default_host(struct irq_domain *domain)
435
{
436
	pr_debug("Default domain set to @0x%p\n", domain);
437

438
	irq_default_domain = domain;
439
}
440
EXPORT_SYMBOL_GPL(irq_set_default_host);
441

442
void irq_domain_disassociate(struct irq_domain *domain, unsigned int irq)
443
{
444 445
	struct irq_data *irq_data = irq_get_irq_data(irq);
	irq_hw_number_t hwirq;
446

447 448 449
	if (WARN(!irq_data || irq_data->domain != domain,
		 "virq%i doesn't exist; cannot disassociate\n", irq))
		return;
450

451 452
	hwirq = irq_data->hwirq;
	irq_set_status_flags(irq, IRQ_NOREQUEST);
453

454 455
	/* remove chip and handler */
	irq_set_chip_and_handler(irq, NULL, NULL);
456

457 458
	/* Make sure it's completed */
	synchronize_irq(irq);
459

460 461 462 463
	/* Tell the PIC about it */
	if (domain->ops->unmap)
		domain->ops->unmap(domain, irq);
	smp_mb();
464

465 466
	irq_data->domain = NULL;
	irq_data->hwirq = 0;
467
	domain->mapcount--;
468

469 470 471 472 473 474 475
	/* Clear reverse map for this hwirq */
	if (hwirq < domain->revmap_size) {
		domain->linear_revmap[hwirq] = 0;
	} else {
		mutex_lock(&revmap_trees_mutex);
		radix_tree_delete(&domain->revmap_tree, hwirq);
		mutex_unlock(&revmap_trees_mutex);
476 477 478
	}
}

479 480
int irq_domain_associate(struct irq_domain *domain, unsigned int virq,
			 irq_hw_number_t hwirq)
481
{
482 483
	struct irq_data *irq_data = irq_get_irq_data(virq);
	int ret;
484

485 486 487 488 489 490 491
	if (WARN(hwirq >= domain->hwirq_max,
		 "error: hwirq 0x%x is too large for %s\n", (int)hwirq, domain->name))
		return -EINVAL;
	if (WARN(!irq_data, "error: virq%i is not allocated", virq))
		return -EINVAL;
	if (WARN(irq_data->domain, "error: virq%i is already associated", virq))
		return -EINVAL;
492

493 494 495 496 497 498 499 500 501 502 503 504 505 506
	mutex_lock(&irq_domain_mutex);
	irq_data->hwirq = hwirq;
	irq_data->domain = domain;
	if (domain->ops->map) {
		ret = domain->ops->map(domain, virq, hwirq);
		if (ret != 0) {
			/*
			 * If map() returns -EPERM, this interrupt is protected
			 * by the firmware or some other service and shall not
			 * be mapped. Don't bother telling the user about it.
			 */
			if (ret != -EPERM) {
				pr_info("%s didn't like hwirq-0x%lx to VIRQ%i mapping (rc=%d)\n",
				       domain->name, hwirq, virq, ret);
507
			}
508 509 510 511
			irq_data->domain = NULL;
			irq_data->hwirq = 0;
			mutex_unlock(&irq_domain_mutex);
			return ret;
512 513
		}

514 515 516 517
		/* If not already assigned, give the domain the chip's name */
		if (!domain->name && irq_data->chip)
			domain->name = irq_data->chip->name;
	}
518

519
	domain->mapcount++;
520 521 522 523 524 525
	if (hwirq < domain->revmap_size) {
		domain->linear_revmap[hwirq] = virq;
	} else {
		mutex_lock(&revmap_trees_mutex);
		radix_tree_insert(&domain->revmap_tree, hwirq, irq_data);
		mutex_unlock(&revmap_trees_mutex);
526
	}
527 528 529
	mutex_unlock(&irq_domain_mutex);

	irq_clear_status_flags(virq, IRQ_NOREQUEST);
530 531 532

	return 0;
}
533
EXPORT_SYMBOL_GPL(irq_domain_associate);
534

535 536 537
void irq_domain_associate_many(struct irq_domain *domain, unsigned int irq_base,
			       irq_hw_number_t hwirq_base, int count)
{
538
	struct device_node *of_node;
539 540
	int i;

541
	of_node = irq_domain_get_of_node(domain);
542
	pr_debug("%s(%s, irqbase=%i, hwbase=%i, count=%i)\n", __func__,
543
		of_node_full_name(of_node), irq_base, (int)hwirq_base, count);
544 545 546 547

	for (i = 0; i < count; i++) {
		irq_domain_associate(domain, irq_base + i, hwirq_base + i);
	}
548
}
549
EXPORT_SYMBOL_GPL(irq_domain_associate_many);
550 551 552

/**
 * irq_create_direct_mapping() - Allocate an irq for direct mapping
553
 * @domain: domain to allocate the irq for or NULL for default domain
554 555 556
 *
 * This routine is used for irq controllers which can choose the hardware
 * interrupt numbers they generate. In such a case it's simplest to use
G
Grant Likely 已提交
557 558 559
 * the linux irq as the hardware interrupt number. It still uses the linear
 * or radix tree to store the mapping, but the irq controller can optimize
 * the revmap path by using the hwirq directly.
560
 */
561
unsigned int irq_create_direct_mapping(struct irq_domain *domain)
562
{
563
	struct device_node *of_node;
564 565
	unsigned int virq;

566 567
	if (domain == NULL)
		domain = irq_default_domain;
568

569 570
	of_node = irq_domain_get_of_node(domain);
	virq = irq_alloc_desc_from(1, of_node_to_nid(of_node));
571
	if (!virq) {
572
		pr_debug("create_direct virq allocation failed\n");
573
		return 0;
574
	}
G
Grant Likely 已提交
575
	if (virq >= domain->revmap_direct_max_irq) {
576
		pr_err("ERROR: no free irqs available below %i maximum\n",
G
Grant Likely 已提交
577
			domain->revmap_direct_max_irq);
578 579 580
		irq_free_desc(virq);
		return 0;
	}
581
	pr_debug("create_direct obtained virq %d\n", virq);
582

583
	if (irq_domain_associate(domain, virq, virq)) {
584
		irq_free_desc(virq);
585
		return 0;
586 587 588 589
	}

	return virq;
}
590
EXPORT_SYMBOL_GPL(irq_create_direct_mapping);
591 592 593

/**
 * irq_create_mapping() - Map a hardware interrupt into linux irq space
594 595
 * @domain: domain owning this hardware interrupt or NULL for default domain
 * @hwirq: hardware irq number in that domain space
596 597 598 599 600 601
 *
 * Only one mapping per hardware interrupt is permitted. Returns a linux
 * irq number.
 * If the sense/trigger is to be specified, set_irq_type() should be called
 * on the number returned from that call.
 */
602
unsigned int irq_create_mapping(struct irq_domain *domain,
603 604
				irq_hw_number_t hwirq)
{
605
	struct device_node *of_node;
606
	int virq;
607

608
	pr_debug("irq_create_mapping(0x%p, 0x%lx)\n", domain, hwirq);
609

610 611 612 613
	/* Look for default domain if nececssary */
	if (domain == NULL)
		domain = irq_default_domain;
	if (domain == NULL) {
K
Kefeng Wang 已提交
614
		WARN(1, "%s(, %lx) called with NULL domain\n", __func__, hwirq);
615
		return 0;
616
	}
617
	pr_debug("-> using domain @%p\n", domain);
618

619 620
	of_node = irq_domain_get_of_node(domain);

621
	/* Check if mapping already exists */
622
	virq = irq_find_mapping(domain, hwirq);
623
	if (virq) {
624
		pr_debug("-> existing mapping on virq %d\n", virq);
625 626 627
		return virq;
	}

628
	/* Allocate a virtual interrupt number */
629
	virq = irq_domain_alloc_descs(-1, 1, hwirq, of_node_to_nid(of_node), NULL);
630
	if (virq <= 0) {
631
		pr_debug("-> virq allocation failed\n");
632
		return 0;
633 634
	}

635
	if (irq_domain_associate(domain, virq, hwirq)) {
636
		irq_free_desc(virq);
637
		return 0;
638 639
	}

640
	pr_debug("irq %lu on domain %s mapped to virtual irq %u\n",
641
		hwirq, of_node_full_name(of_node), virq);
642 643 644 645 646

	return virq;
}
EXPORT_SYMBOL_GPL(irq_create_mapping);

647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667
/**
 * irq_create_strict_mappings() - Map a range of hw irqs to fixed linux irqs
 * @domain: domain owning the interrupt range
 * @irq_base: beginning of linux IRQ range
 * @hwirq_base: beginning of hardware IRQ range
 * @count: Number of interrupts to map
 *
 * This routine is used for allocating and mapping a range of hardware
 * irqs to linux irqs where the linux irq numbers are at pre-defined
 * locations. For use by controllers that already have static mappings
 * to insert in to the domain.
 *
 * Non-linear users can use irq_create_identity_mapping() for IRQ-at-a-time
 * domain insertion.
 *
 * 0 is returned upon success, while any failure to establish a static
 * mapping is treated as an error.
 */
int irq_create_strict_mappings(struct irq_domain *domain, unsigned int irq_base,
			       irq_hw_number_t hwirq_base, int count)
{
668
	struct device_node *of_node;
669 670
	int ret;

671
	of_node = irq_domain_get_of_node(domain);
672
	ret = irq_alloc_descs(irq_base, irq_base, count,
673
			      of_node_to_nid(of_node));
674 675 676
	if (unlikely(ret < 0))
		return ret;

677
	irq_domain_associate_many(domain, irq_base, hwirq_base, count);
678 679 680 681
	return 0;
}
EXPORT_SYMBOL_GPL(irq_create_strict_mappings);

682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711
static int irq_domain_translate(struct irq_domain *d,
				struct irq_fwspec *fwspec,
				irq_hw_number_t *hwirq, unsigned int *type)
{
#ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
	if (d->ops->translate)
		return d->ops->translate(d, fwspec, hwirq, type);
#endif
	if (d->ops->xlate)
		return d->ops->xlate(d, to_of_node(fwspec->fwnode),
				     fwspec->param, fwspec->param_count,
				     hwirq, type);

	/* If domain has no translation, then we assume interrupt line */
	*hwirq = fwspec->param[0];
	return 0;
}

static void of_phandle_args_to_fwspec(struct of_phandle_args *irq_data,
				      struct irq_fwspec *fwspec)
{
	int i;

	fwspec->fwnode = irq_data->np ? &irq_data->np->fwnode : NULL;
	fwspec->param_count = irq_data->args_count;

	for (i = 0; i < irq_data->args_count; i++)
		fwspec->param[i] = irq_data->args[i];
}

712
unsigned int irq_create_fwspec_mapping(struct irq_fwspec *fwspec)
713
{
714
	struct irq_domain *domain;
715
	struct irq_data *irq_data;
716 717
	irq_hw_number_t hwirq;
	unsigned int type = IRQ_TYPE_NONE;
718
	int virq;
719

720
	if (fwspec->fwnode) {
721
		domain = irq_find_matching_fwspec(fwspec, DOMAIN_BUS_WIRED);
722
		if (!domain)
723
			domain = irq_find_matching_fwspec(fwspec, DOMAIN_BUS_ANY);
724
	} else {
725
		domain = irq_default_domain;
726
	}
727

728
	if (!domain) {
K
Kefeng Wang 已提交
729
		pr_warn("no irq domain found for %s !\n",
730
			of_node_full_name(to_of_node(fwspec->fwnode)));
731
		return 0;
732 733
	}

734
	if (irq_domain_translate(domain, fwspec, &hwirq, &type))
735
		return 0;
736

737 738 739 740 741 742 743 744 745 746 747 748 749
	/*
	 * WARN if the irqchip returns a type with bits
	 * outside the sense mask set and clear these bits.
	 */
	if (WARN_ON(type & ~IRQ_TYPE_SENSE_MASK))
		type &= IRQ_TYPE_SENSE_MASK;

	/*
	 * If we've already configured this interrupt,
	 * don't do it again, or hell will break loose.
	 */
	virq = irq_find_mapping(domain, hwirq);
	if (virq) {
750
		/*
751 752 753
		 * If the trigger type is not specified or matches the
		 * current trigger type then we are done so return the
		 * interrupt number.
754
		 */
755
		if (type == IRQ_TYPE_NONE || type == irq_get_trigger_type(virq))
756 757
			return virq;

758 759 760 761 762
		/*
		 * If the trigger type has not been set yet, then set
		 * it now and return the interrupt number.
		 */
		if (irq_get_trigger_type(virq) == IRQ_TYPE_NONE) {
763 764 765 766 767
			irq_data = irq_get_irq_data(virq);
			if (!irq_data)
				return 0;

			irqd_set_trigger_type(irq_data, type);
768 769 770 771 772 773 774 775 776
			return virq;
		}

		pr_warn("type mismatch, failed to map hwirq-%lu for %s!\n",
			hwirq, of_node_full_name(to_of_node(fwspec->fwnode)));
		return 0;
	}

	if (irq_domain_is_hierarchy(domain)) {
777
		virq = irq_domain_alloc_irqs(domain, 1, NUMA_NO_NODE, fwspec);
778 779 780 781 782 783 784 785
		if (virq <= 0)
			return 0;
	} else {
		/* Create mapping */
		virq = irq_create_mapping(domain, hwirq);
		if (!virq)
			return virq;
	}
786

787 788 789 790 791 792 793 794 795 796 797 798
	irq_data = irq_get_irq_data(virq);
	if (!irq_data) {
		if (irq_domain_is_hierarchy(domain))
			irq_domain_free_irqs(virq, 1);
		else
			irq_dispose_mapping(virq);
		return 0;
	}

	/* Store trigger type */
	irqd_set_trigger_type(irq_data, type);

799 800
	return virq;
}
801 802 803 804 805 806 807 808 809
EXPORT_SYMBOL_GPL(irq_create_fwspec_mapping);

unsigned int irq_create_of_mapping(struct of_phandle_args *irq_data)
{
	struct irq_fwspec fwspec;

	of_phandle_args_to_fwspec(irq_data, &fwspec);
	return irq_create_fwspec_mapping(&fwspec);
}
810 811 812 813 814 815 816 817 818
EXPORT_SYMBOL_GPL(irq_create_of_mapping);

/**
 * irq_dispose_mapping() - Unmap an interrupt
 * @virq: linux irq number of the interrupt to unmap
 */
void irq_dispose_mapping(unsigned int virq)
{
	struct irq_data *irq_data = irq_get_irq_data(virq);
819
	struct irq_domain *domain;
820

821
	if (!virq || !irq_data)
822 823
		return;

824 825
	domain = irq_data->domain;
	if (WARN_ON(domain == NULL))
826 827
		return;

828 829 830 831 832 833
	if (irq_domain_is_hierarchy(domain)) {
		irq_domain_free_irqs(virq, 1);
	} else {
		irq_domain_disassociate(domain, virq);
		irq_free_desc(virq);
	}
834 835 836 837 838
}
EXPORT_SYMBOL_GPL(irq_dispose_mapping);

/**
 * irq_find_mapping() - Find a linux irq from an hw irq number.
839 840
 * @domain: domain owning this hardware interrupt
 * @hwirq: hardware irq number in that domain space
841
 */
842
unsigned int irq_find_mapping(struct irq_domain *domain,
843 844
			      irq_hw_number_t hwirq)
{
845
	struct irq_data *data;
846

847 848 849 850
	/* Look for default domain if nececssary */
	if (domain == NULL)
		domain = irq_default_domain;
	if (domain == NULL)
851
		return 0;
852

G
Grant Likely 已提交
853
	if (hwirq < domain->revmap_direct_max_irq) {
854 855
		data = irq_domain_get_irq_data(domain, hwirq);
		if (data && data->hwirq == hwirq)
856 857 858
			return hwirq;
	}

859 860 861
	/* Check if the hwirq is in the linear revmap. */
	if (hwirq < domain->revmap_size)
		return domain->linear_revmap[hwirq];
862

863 864 865 866
	rcu_read_lock();
	data = radix_tree_lookup(&domain->revmap_tree, hwirq);
	rcu_read_unlock();
	return data ? data->irq : 0;
867 868 869
}
EXPORT_SYMBOL_GPL(irq_find_mapping);

870
#ifdef CONFIG_IRQ_DOMAIN_DEBUG
871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911
static void virq_debug_show_one(struct seq_file *m, struct irq_desc *desc)
{
	struct irq_domain *domain;
	struct irq_data *data;

	domain = desc->irq_data.domain;
	data = &desc->irq_data;

	while (domain) {
		unsigned int irq = data->irq;
		unsigned long hwirq = data->hwirq;
		struct irq_chip *chip;
		bool direct;

		if (data == &desc->irq_data)
			seq_printf(m, "%5d  ", irq);
		else
			seq_printf(m, "%5d+ ", irq);
		seq_printf(m, "0x%05lx  ", hwirq);

		chip = irq_data_get_irq_chip(data);
		seq_printf(m, "%-15s  ", (chip && chip->name) ? chip->name : "none");

		seq_printf(m, data ? "0x%p  " : "  %p  ",
			   irq_data_get_irq_chip_data(data));

		seq_printf(m, "   %c    ", (desc->action && desc->action->handler) ? '*' : ' ');
		direct = (irq == hwirq) && (irq < domain->revmap_direct_max_irq);
		seq_printf(m, "%6s%-8s  ",
			   (hwirq < domain->revmap_size) ? "LINEAR" : "RADIX",
			   direct ? "(DIRECT)" : "");
		seq_printf(m, "%s\n", domain->name);
#ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
		domain = domain->parent;
		data = data->parent_data;
#else
		domain = NULL;
#endif
	}
}

912 913 914 915
static int virq_debug_show(struct seq_file *m, void *private)
{
	unsigned long flags;
	struct irq_desc *desc;
G
Grant Likely 已提交
916 917
	struct irq_domain *domain;
	struct radix_tree_iter iter;
918
	void **slot;
919 920
	int i;

G
Grant Likely 已提交
921 922 923 924
	seq_printf(m, " %-16s  %-6s  %-10s  %-10s  %s\n",
		   "name", "mapped", "linear-max", "direct-max", "devtree-node");
	mutex_lock(&irq_domain_mutex);
	list_for_each_entry(domain, &irq_domain_list, link) {
925
		struct device_node *of_node;
926 927
		const char *name;

G
Grant Likely 已提交
928
		int count = 0;
929

930
		of_node = irq_domain_get_of_node(domain);
931 932 933 934 935 936 937 938
		if (of_node)
			name = of_node_full_name(of_node);
		else if (is_fwnode_irqchip(domain->fwnode))
			name = container_of(domain->fwnode, struct irqchip_fwid,
					    fwnode)->name;
		else
			name = "";

G
Grant Likely 已提交
939 940 941 942 943 944
		radix_tree_for_each_slot(slot, &domain->revmap_tree, &iter, 0)
			count++;
		seq_printf(m, "%c%-16s  %6u  %10u  %10u  %s\n",
			   domain == irq_default_domain ? '*' : ' ', domain->name,
			   domain->revmap_size + count, domain->revmap_size,
			   domain->revmap_direct_max_irq,
945
			   name);
G
Grant Likely 已提交
946 947 948 949
	}
	mutex_unlock(&irq_domain_mutex);

	seq_printf(m, "%-5s  %-7s  %-15s  %-*s  %6s  %-14s  %s\n", "irq", "hwirq",
950
		      "chip name", (int)(2 * sizeof(void *) + 2), "chip data",
G
Grant Likely 已提交
951
		      "active", "type", "domain");
952 953 954 955 956 957 958

	for (i = 1; i < nr_irqs; i++) {
		desc = irq_to_desc(i);
		if (!desc)
			continue;

		raw_spin_lock_irqsave(&desc->lock, flags);
959
		virq_debug_show_one(m, desc);
960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979
		raw_spin_unlock_irqrestore(&desc->lock, flags);
	}

	return 0;
}

static int virq_debug_open(struct inode *inode, struct file *file)
{
	return single_open(file, virq_debug_show, inode->i_private);
}

static const struct file_operations virq_debug_fops = {
	.open = virq_debug_open,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
};

static int __init irq_debugfs_init(void)
{
980
	if (debugfs_create_file("irq_domain_mapping", S_IRUGO, NULL,
981 982 983 984 985 986
				 NULL, &virq_debug_fops) == NULL)
		return -ENOMEM;

	return 0;
}
__initcall(irq_debugfs_init);
987
#endif /* CONFIG_IRQ_DOMAIN_DEBUG */
988

989 990 991 992 993 994 995 996 997
/**
 * irq_domain_xlate_onecell() - Generic xlate for direct one cell bindings
 *
 * Device Tree IRQ specifier translation function which works with one cell
 * bindings where the cell value maps directly to the hwirq number.
 */
int irq_domain_xlate_onecell(struct irq_domain *d, struct device_node *ctrlr,
			     const u32 *intspec, unsigned int intsize,
			     unsigned long *out_hwirq, unsigned int *out_type)
998
{
999
	if (WARN_ON(intsize < 1))
1000 1001 1002 1003 1004
		return -EINVAL;
	*out_hwirq = intspec[0];
	*out_type = IRQ_TYPE_NONE;
	return 0;
}
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 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044
EXPORT_SYMBOL_GPL(irq_domain_xlate_onecell);

/**
 * irq_domain_xlate_twocell() - Generic xlate for direct two cell bindings
 *
 * Device Tree IRQ specifier translation function which works with two cell
 * bindings where the cell values map directly to the hwirq number
 * and linux irq flags.
 */
int irq_domain_xlate_twocell(struct irq_domain *d, struct device_node *ctrlr,
			const u32 *intspec, unsigned int intsize,
			irq_hw_number_t *out_hwirq, unsigned int *out_type)
{
	if (WARN_ON(intsize < 2))
		return -EINVAL;
	*out_hwirq = intspec[0];
	*out_type = intspec[1] & IRQ_TYPE_SENSE_MASK;
	return 0;
}
EXPORT_SYMBOL_GPL(irq_domain_xlate_twocell);

/**
 * irq_domain_xlate_onetwocell() - Generic xlate for one or two cell bindings
 *
 * Device Tree IRQ specifier translation function which works with either one
 * or two cell bindings where the cell values map directly to the hwirq number
 * and linux irq flags.
 *
 * Note: don't use this function unless your interrupt controller explicitly
 * supports both one and two cell bindings.  For the majority of controllers
 * the _onecell() or _twocell() variants above should be used.
 */
int irq_domain_xlate_onetwocell(struct irq_domain *d,
				struct device_node *ctrlr,
				const u32 *intspec, unsigned int intsize,
				unsigned long *out_hwirq, unsigned int *out_type)
{
	if (WARN_ON(intsize < 1))
		return -EINVAL;
	*out_hwirq = intspec[0];
1045 1046 1047 1048
	if (intsize > 1)
		*out_type = intspec[1] & IRQ_TYPE_SENSE_MASK;
	else
		*out_type = IRQ_TYPE_NONE;
1049 1050 1051
	return 0;
}
EXPORT_SYMBOL_GPL(irq_domain_xlate_onetwocell);
1052

1053
const struct irq_domain_ops irq_domain_simple_ops = {
1054
	.xlate = irq_domain_xlate_onetwocell,
1055 1056
};
EXPORT_SYMBOL_GPL(irq_domain_simple_ops);
1057

1058
int irq_domain_alloc_descs(int virq, unsigned int cnt, irq_hw_number_t hwirq,
1059
			   int node, const struct cpumask *affinity)
1060 1061 1062 1063
{
	unsigned int hint;

	if (virq >= 0) {
1064 1065
		virq = __irq_alloc_descs(virq, virq, cnt, node, THIS_MODULE,
					 affinity);
1066 1067 1068 1069
	} else {
		hint = hwirq % nr_irqs;
		if (hint == 0)
			hint++;
1070 1071 1072 1073 1074 1075
		virq = __irq_alloc_descs(-1, hint, cnt, node, THIS_MODULE,
					 affinity);
		if (virq <= 0 && hint > 1) {
			virq = __irq_alloc_descs(-1, 1, cnt, node, THIS_MODULE,
						 affinity);
		}
1076 1077 1078 1079 1080 1081
	}

	return virq;
}

#ifdef	CONFIG_IRQ_DOMAIN_HIERARCHY
1082
/**
1083
 * irq_domain_create_hierarchy - Add a irqdomain into the hierarchy
1084 1085 1086
 * @parent:	Parent irq domain to associate with the new domain
 * @flags:	Irq domain flags associated to the domain
 * @size:	Size of the domain. See below
1087
 * @fwnode:	Optional fwnode of the interrupt controller
1088 1089 1090 1091 1092 1093 1094 1095 1096
 * @ops:	Pointer to the interrupt domain callbacks
 * @host_data:	Controller private data pointer
 *
 * If @size is 0 a tree domain is created, otherwise a linear domain.
 *
 * If successful the parent is associated to the new domain and the
 * domain flags are set.
 * Returns pointer to IRQ domain, or NULL on failure.
 */
1097
struct irq_domain *irq_domain_create_hierarchy(struct irq_domain *parent,
1098 1099
					    unsigned int flags,
					    unsigned int size,
1100
					    struct fwnode_handle *fwnode,
1101 1102 1103 1104 1105 1106
					    const struct irq_domain_ops *ops,
					    void *host_data)
{
	struct irq_domain *domain;

	if (size)
1107
		domain = irq_domain_create_linear(fwnode, size, ops, host_data);
1108
	else
1109
		domain = irq_domain_create_tree(fwnode, ops, host_data);
1110 1111 1112 1113 1114 1115 1116
	if (domain) {
		domain->parent = parent;
		domain->flags |= flags;
	}

	return domain;
}
1117
EXPORT_SYMBOL_GPL(irq_domain_create_hierarchy);
1118

1119 1120 1121 1122 1123 1124 1125 1126
static void irq_domain_insert_irq(int virq)
{
	struct irq_data *data;

	for (data = irq_get_irq_data(virq); data; data = data->parent_data) {
		struct irq_domain *domain = data->domain;
		irq_hw_number_t hwirq = data->hwirq;

1127
		domain->mapcount++;
1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156
		if (hwirq < domain->revmap_size) {
			domain->linear_revmap[hwirq] = virq;
		} else {
			mutex_lock(&revmap_trees_mutex);
			radix_tree_insert(&domain->revmap_tree, hwirq, data);
			mutex_unlock(&revmap_trees_mutex);
		}

		/* If not already assigned, give the domain the chip's name */
		if (!domain->name && data->chip)
			domain->name = data->chip->name;
	}

	irq_clear_status_flags(virq, IRQ_NOREQUEST);
}

static void irq_domain_remove_irq(int virq)
{
	struct irq_data *data;

	irq_set_status_flags(virq, IRQ_NOREQUEST);
	irq_set_chip_and_handler(virq, NULL, NULL);
	synchronize_irq(virq);
	smp_mb();

	for (data = irq_get_irq_data(virq); data; data = data->parent_data) {
		struct irq_domain *domain = data->domain;
		irq_hw_number_t hwirq = data->hwirq;

1157
		domain->mapcount--;
1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172
		if (hwirq < domain->revmap_size) {
			domain->linear_revmap[hwirq] = 0;
		} else {
			mutex_lock(&revmap_trees_mutex);
			radix_tree_delete(&domain->revmap_tree, hwirq);
			mutex_unlock(&revmap_trees_mutex);
		}
	}
}

static struct irq_data *irq_domain_insert_irq_data(struct irq_domain *domain,
						   struct irq_data *child)
{
	struct irq_data *irq_data;

1173 1174
	irq_data = kzalloc_node(sizeof(*irq_data), GFP_KERNEL,
				irq_data_get_node(child));
1175 1176 1177
	if (irq_data) {
		child->parent_data = irq_data;
		irq_data->irq = child->irq;
1178
		irq_data->common = child->common;
1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244
		irq_data->domain = domain;
	}

	return irq_data;
}

static void irq_domain_free_irq_data(unsigned int virq, unsigned int nr_irqs)
{
	struct irq_data *irq_data, *tmp;
	int i;

	for (i = 0; i < nr_irqs; i++) {
		irq_data = irq_get_irq_data(virq + i);
		tmp = irq_data->parent_data;
		irq_data->parent_data = NULL;
		irq_data->domain = NULL;

		while (tmp) {
			irq_data = tmp;
			tmp = tmp->parent_data;
			kfree(irq_data);
		}
	}
}

static int irq_domain_alloc_irq_data(struct irq_domain *domain,
				     unsigned int virq, unsigned int nr_irqs)
{
	struct irq_data *irq_data;
	struct irq_domain *parent;
	int i;

	/* The outermost irq_data is embedded in struct irq_desc */
	for (i = 0; i < nr_irqs; i++) {
		irq_data = irq_get_irq_data(virq + i);
		irq_data->domain = domain;

		for (parent = domain->parent; parent; parent = parent->parent) {
			irq_data = irq_domain_insert_irq_data(parent, irq_data);
			if (!irq_data) {
				irq_domain_free_irq_data(virq, i + 1);
				return -ENOMEM;
			}
		}
	}

	return 0;
}

/**
 * irq_domain_get_irq_data - Get irq_data associated with @virq and @domain
 * @domain:	domain to match
 * @virq:	IRQ number to get irq_data
 */
struct irq_data *irq_domain_get_irq_data(struct irq_domain *domain,
					 unsigned int virq)
{
	struct irq_data *irq_data;

	for (irq_data = irq_get_irq_data(virq); irq_data;
	     irq_data = irq_data->parent_data)
		if (irq_data->domain == domain)
			return irq_data;

	return NULL;
}
1245
EXPORT_SYMBOL_GPL(irq_domain_get_irq_data);
1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269

/**
 * irq_domain_set_hwirq_and_chip - Set hwirq and irqchip of @virq at @domain
 * @domain:	Interrupt domain to match
 * @virq:	IRQ number
 * @hwirq:	The hwirq number
 * @chip:	The associated interrupt chip
 * @chip_data:	The associated chip data
 */
int irq_domain_set_hwirq_and_chip(struct irq_domain *domain, unsigned int virq,
				  irq_hw_number_t hwirq, struct irq_chip *chip,
				  void *chip_data)
{
	struct irq_data *irq_data = irq_domain_get_irq_data(domain, virq);

	if (!irq_data)
		return -ENOENT;

	irq_data->hwirq = hwirq;
	irq_data->chip = chip ? chip : &no_irq_chip;
	irq_data->chip_data = chip_data;

	return 0;
}
1270
EXPORT_SYMBOL_GPL(irq_domain_set_hwirq_and_chip);
1271

1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291
/**
 * irq_domain_set_info - Set the complete data for a @virq in @domain
 * @domain:		Interrupt domain to match
 * @virq:		IRQ number
 * @hwirq:		The hardware interrupt number
 * @chip:		The associated interrupt chip
 * @chip_data:		The associated interrupt chip data
 * @handler:		The interrupt flow handler
 * @handler_data:	The interrupt flow handler data
 * @handler_name:	The interrupt handler name
 */
void irq_domain_set_info(struct irq_domain *domain, unsigned int virq,
			 irq_hw_number_t hwirq, struct irq_chip *chip,
			 void *chip_data, irq_flow_handler_t handler,
			 void *handler_data, const char *handler_name)
{
	irq_domain_set_hwirq_and_chip(domain, virq, hwirq, chip, chip_data);
	__irq_set_handler(virq, handler, 0, handler_name);
	irq_set_handler_data(virq, handler_data);
}
1292
EXPORT_SYMBOL(irq_domain_set_info);
1293

1294 1295 1296 1297 1298 1299 1300 1301 1302 1303
/**
 * irq_domain_reset_irq_data - Clear hwirq, chip and chip_data in @irq_data
 * @irq_data:	The pointer to irq_data
 */
void irq_domain_reset_irq_data(struct irq_data *irq_data)
{
	irq_data->hwirq = 0;
	irq_data->chip = &no_irq_chip;
	irq_data->chip_data = NULL;
}
1304
EXPORT_SYMBOL_GPL(irq_domain_reset_irq_data);
1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324

/**
 * irq_domain_free_irqs_common - Clear irq_data and free the parent
 * @domain:	Interrupt domain to match
 * @virq:	IRQ number to start with
 * @nr_irqs:	The number of irqs to free
 */
void irq_domain_free_irqs_common(struct irq_domain *domain, unsigned int virq,
				 unsigned int nr_irqs)
{
	struct irq_data *irq_data;
	int i;

	for (i = 0; i < nr_irqs; i++) {
		irq_data = irq_domain_get_irq_data(domain, virq + i);
		if (irq_data)
			irq_domain_reset_irq_data(irq_data);
	}
	irq_domain_free_irqs_parent(domain, virq, nr_irqs);
}
1325
EXPORT_SYMBOL_GPL(irq_domain_free_irqs_common);
1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344

/**
 * irq_domain_free_irqs_top - Clear handler and handler data, clear irqdata and free parent
 * @domain:	Interrupt domain to match
 * @virq:	IRQ number to start with
 * @nr_irqs:	The number of irqs to free
 */
void irq_domain_free_irqs_top(struct irq_domain *domain, unsigned int virq,
			      unsigned int nr_irqs)
{
	int i;

	for (i = 0; i < nr_irqs; i++) {
		irq_set_handler_data(virq + i, NULL);
		irq_set_handler(virq + i, NULL);
	}
	irq_domain_free_irqs_common(domain, virq, nr_irqs);
}

1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361
static bool irq_domain_is_auto_recursive(struct irq_domain *domain)
{
	return domain->flags & IRQ_DOMAIN_FLAG_AUTO_RECURSIVE;
}

static void irq_domain_free_irqs_recursive(struct irq_domain *domain,
					   unsigned int irq_base,
					   unsigned int nr_irqs)
{
	domain->ops->free(domain, irq_base, nr_irqs);
	if (irq_domain_is_auto_recursive(domain)) {
		BUG_ON(!domain->parent);
		irq_domain_free_irqs_recursive(domain->parent, irq_base,
					       nr_irqs);
	}
}

1362 1363 1364
int irq_domain_alloc_irqs_recursive(struct irq_domain *domain,
				    unsigned int irq_base,
				    unsigned int nr_irqs, void *arg)
1365 1366 1367 1368 1369 1370 1371 1372 1373
{
	int ret = 0;
	struct irq_domain *parent = domain->parent;
	bool recursive = irq_domain_is_auto_recursive(domain);

	BUG_ON(recursive && !parent);
	if (recursive)
		ret = irq_domain_alloc_irqs_recursive(parent, irq_base,
						      nr_irqs, arg);
1374 1375 1376 1377
	if (ret < 0)
		return ret;

	ret = domain->ops->alloc(domain, irq_base, nr_irqs, arg);
1378 1379 1380 1381 1382 1383
	if (ret < 0 && recursive)
		irq_domain_free_irqs_recursive(parent, irq_base, nr_irqs);

	return ret;
}

1384 1385 1386 1387 1388 1389 1390 1391
/**
 * __irq_domain_alloc_irqs - Allocate IRQs from domain
 * @domain:	domain to allocate from
 * @irq_base:	allocate specified IRQ nubmer if irq_base >= 0
 * @nr_irqs:	number of IRQs to allocate
 * @node:	NUMA node id for memory allocation
 * @arg:	domain specific argument
 * @realloc:	IRQ descriptors have already been allocated if true
1392
 * @affinity:	Optional irq affinity mask for multiqueue devices
1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407
 *
 * Allocate IRQ numbers and initialized all data structures to support
 * hierarchy IRQ domains.
 * Parameter @realloc is mainly to support legacy IRQs.
 * Returns error code or allocated IRQ number
 *
 * The whole process to setup an IRQ has been split into two steps.
 * The first step, __irq_domain_alloc_irqs(), is to allocate IRQ
 * descriptor and required hardware resources. The second step,
 * irq_domain_activate_irq(), is to program hardwares with preallocated
 * resources. In this way, it's easier to rollback when failing to
 * allocate resources.
 */
int __irq_domain_alloc_irqs(struct irq_domain *domain, int irq_base,
			    unsigned int nr_irqs, int node, void *arg,
1408
			    bool realloc, const struct cpumask *affinity)
1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425
{
	int i, ret, virq;

	if (domain == NULL) {
		domain = irq_default_domain;
		if (WARN(!domain, "domain is NULL; cannot allocate IRQ\n"))
			return -EINVAL;
	}

	if (!domain->ops->alloc) {
		pr_debug("domain->ops->alloc() is NULL\n");
		return -ENOSYS;
	}

	if (realloc && irq_base >= 0) {
		virq = irq_base;
	} else {
1426 1427
		virq = irq_domain_alloc_descs(irq_base, nr_irqs, 0, node,
					      affinity);
1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441
		if (virq < 0) {
			pr_debug("cannot allocate IRQ(base %d, count %d)\n",
				 irq_base, nr_irqs);
			return virq;
		}
	}

	if (irq_domain_alloc_irq_data(domain, virq, nr_irqs)) {
		pr_debug("cannot allocate memory for IRQ%d\n", virq);
		ret = -ENOMEM;
		goto out_free_desc;
	}

	mutex_lock(&irq_domain_mutex);
1442
	ret = irq_domain_alloc_irqs_recursive(domain, virq, nr_irqs, arg);
1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476
	if (ret < 0) {
		mutex_unlock(&irq_domain_mutex);
		goto out_free_irq_data;
	}
	for (i = 0; i < nr_irqs; i++)
		irq_domain_insert_irq(virq + i);
	mutex_unlock(&irq_domain_mutex);

	return virq;

out_free_irq_data:
	irq_domain_free_irq_data(virq, nr_irqs);
out_free_desc:
	irq_free_descs(virq, nr_irqs);
	return ret;
}

/**
 * irq_domain_free_irqs - Free IRQ number and associated data structures
 * @virq:	base IRQ number
 * @nr_irqs:	number of IRQs to free
 */
void irq_domain_free_irqs(unsigned int virq, unsigned int nr_irqs)
{
	struct irq_data *data = irq_get_irq_data(virq);
	int i;

	if (WARN(!data || !data->domain || !data->domain->ops->free,
		 "NULL pointer, cannot free irq\n"))
		return;

	mutex_lock(&irq_domain_mutex);
	for (i = 0; i < nr_irqs; i++)
		irq_domain_remove_irq(virq + i);
1477
	irq_domain_free_irqs_recursive(data->domain, virq, nr_irqs);
1478 1479 1480 1481 1482 1483
	mutex_unlock(&irq_domain_mutex);

	irq_domain_free_irq_data(virq, nr_irqs);
	irq_free_descs(virq, nr_irqs);
}

1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506
/**
 * irq_domain_alloc_irqs_parent - Allocate interrupts from parent domain
 * @irq_base:	Base IRQ number
 * @nr_irqs:	Number of IRQs to allocate
 * @arg:	Allocation data (arch/domain specific)
 *
 * Check whether the domain has been setup recursive. If not allocate
 * through the parent domain.
 */
int irq_domain_alloc_irqs_parent(struct irq_domain *domain,
				 unsigned int irq_base, unsigned int nr_irqs,
				 void *arg)
{
	/* irq_domain_alloc_irqs_recursive() has called parent's alloc() */
	if (irq_domain_is_auto_recursive(domain))
		return 0;

	domain = domain->parent;
	if (domain)
		return irq_domain_alloc_irqs_recursive(domain, irq_base,
						       nr_irqs, arg);
	return -ENOSYS;
}
1507
EXPORT_SYMBOL_GPL(irq_domain_alloc_irqs_parent);
1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524

/**
 * irq_domain_free_irqs_parent - Free interrupts from parent domain
 * @irq_base:	Base IRQ number
 * @nr_irqs:	Number of IRQs to free
 *
 * Check whether the domain has been setup recursive. If not free
 * through the parent domain.
 */
void irq_domain_free_irqs_parent(struct irq_domain *domain,
				 unsigned int irq_base, unsigned int nr_irqs)
{
	/* irq_domain_free_irqs_recursive() will call parent's free */
	if (!irq_domain_is_auto_recursive(domain) && domain->parent)
		irq_domain_free_irqs_recursive(domain->parent, irq_base,
					       nr_irqs);
}
1525
EXPORT_SYMBOL_GPL(irq_domain_free_irqs_parent);
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
static void __irq_domain_activate_irq(struct irq_data *irq_data)
{
	if (irq_data && irq_data->domain) {
		struct irq_domain *domain = irq_data->domain;

		if (irq_data->parent_data)
			__irq_domain_activate_irq(irq_data->parent_data);
		if (domain->ops->activate)
			domain->ops->activate(domain, irq_data);
	}
}

static void __irq_domain_deactivate_irq(struct irq_data *irq_data)
{
	if (irq_data && irq_data->domain) {
		struct irq_domain *domain = irq_data->domain;

		if (domain->ops->deactivate)
			domain->ops->deactivate(domain, irq_data);
		if (irq_data->parent_data)
			__irq_domain_deactivate_irq(irq_data->parent_data);
	}
}

1551 1552 1553 1554 1555 1556 1557 1558 1559 1560
/**
 * irq_domain_activate_irq - Call domain_ops->activate recursively to activate
 *			     interrupt
 * @irq_data:	outermost irq_data associated with interrupt
 *
 * This is the second step to call domain_ops->activate to program interrupt
 * controllers, so the interrupt could actually get delivered.
 */
void irq_domain_activate_irq(struct irq_data *irq_data)
{
1561 1562 1563
	if (!irqd_is_activated(irq_data)) {
		__irq_domain_activate_irq(irq_data);
		irqd_set_activated(irq_data);
1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576
	}
}

/**
 * irq_domain_deactivate_irq - Call domain_ops->deactivate recursively to
 *			       deactivate interrupt
 * @irq_data: outermost irq_data associated with interrupt
 *
 * It calls domain_ops->deactivate to program interrupt controllers to disable
 * interrupt delivery.
 */
void irq_domain_deactivate_irq(struct irq_data *irq_data)
{
1577 1578 1579
	if (irqd_is_activated(irq_data)) {
		__irq_domain_deactivate_irq(irq_data);
		irqd_clr_activated(irq_data);
1580 1581 1582 1583 1584 1585 1586 1587 1588
	}
}

static void irq_domain_check_hierarchy(struct irq_domain *domain)
{
	/* Hierarchy irq_domains must implement callback alloc() */
	if (domain->ops->alloc)
		domain->flags |= IRQ_DOMAIN_FLAG_HIERARCHY;
}
1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602

/**
 * irq_domain_hierarchical_is_msi_remap - Check if the domain or any
 * parent has MSI remapping support
 * @domain: domain pointer
 */
bool irq_domain_hierarchical_is_msi_remap(struct irq_domain *domain)
{
	for (; domain; domain = domain->parent) {
		if (irq_domain_is_msi_remap(domain))
			return true;
	}
	return false;
}
1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615
#else	/* CONFIG_IRQ_DOMAIN_HIERARCHY */
/**
 * irq_domain_get_irq_data - Get irq_data associated with @virq and @domain
 * @domain:	domain to match
 * @virq:	IRQ number to get irq_data
 */
struct irq_data *irq_domain_get_irq_data(struct irq_domain *domain,
					 unsigned int virq)
{
	struct irq_data *irq_data = irq_get_irq_data(virq);

	return (irq_data && irq_data->domain == domain) ? irq_data : NULL;
}
1616
EXPORT_SYMBOL_GPL(irq_domain_get_irq_data);
1617

1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638
/**
 * irq_domain_set_info - Set the complete data for a @virq in @domain
 * @domain:		Interrupt domain to match
 * @virq:		IRQ number
 * @hwirq:		The hardware interrupt number
 * @chip:		The associated interrupt chip
 * @chip_data:		The associated interrupt chip data
 * @handler:		The interrupt flow handler
 * @handler_data:	The interrupt flow handler data
 * @handler_name:	The interrupt handler name
 */
void irq_domain_set_info(struct irq_domain *domain, unsigned int virq,
			 irq_hw_number_t hwirq, struct irq_chip *chip,
			 void *chip_data, irq_flow_handler_t handler,
			 void *handler_data, const char *handler_name)
{
	irq_set_chip_and_handler_name(virq, chip, handler, handler_name);
	irq_set_chip_data(virq, chip_data);
	irq_set_handler_data(virq, handler_data);
}

1639 1640 1641 1642
static void irq_domain_check_hierarchy(struct irq_domain *domain)
{
}
#endif	/* CONFIG_IRQ_DOMAIN_HIERARCHY */
1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717

#ifdef CONFIG_GENERIC_IRQ_DEBUGFS
static struct dentry *domain_dir;

static void
irq_domain_debug_show_one(struct seq_file *m, struct irq_domain *d, int ind)
{
	seq_printf(m, "%*sname:   %s\n", ind, "", d->name);
	seq_printf(m, "%*ssize:   %u\n", ind + 1, "",
		   d->revmap_size + d->revmap_direct_max_irq);
	seq_printf(m, "%*smapped: %u\n", ind + 1, "", d->mapcount);
	seq_printf(m, "%*sflags:  0x%08x\n", ind +1 , "", d->flags);
#ifdef	CONFIG_IRQ_DOMAIN_HIERARCHY
	if (!d->parent)
		return;
	seq_printf(m, "%*sparent: %s\n", ind + 1, "", d->parent->name);
	irq_domain_debug_show_one(m, d->parent, ind + 4);
#endif
}

static int irq_domain_debug_show(struct seq_file *m, void *p)
{
	struct irq_domain *d = m->private;

	/* Default domain? Might be NULL */
	if (!d) {
		if (!irq_default_domain)
			return 0;
		d = irq_default_domain;
	}
	irq_domain_debug_show_one(m, d, 0);
	return 0;
}

static int irq_domain_debug_open(struct inode *inode, struct file *file)
{
	return single_open(file, irq_domain_debug_show, inode->i_private);
}

static const struct file_operations dfs_domain_ops = {
	.open		= irq_domain_debug_open,
	.read		= seq_read,
	.llseek		= seq_lseek,
	.release	= single_release,
};

static void debugfs_add_domain_dir(struct irq_domain *d)
{
	if (!d->name || !domain_dir || d->debugfs_file)
		return;
	d->debugfs_file = debugfs_create_file(d->name, 0444, domain_dir, d,
					      &dfs_domain_ops);
}

static void debugfs_remove_domain_dir(struct irq_domain *d)
{
	if (d->debugfs_file)
		debugfs_remove(d->debugfs_file);
}

void __init irq_domain_debugfs_init(struct dentry *root)
{
	struct irq_domain *d;

	domain_dir = debugfs_create_dir("domains", root);
	if (!domain_dir)
		return;

	debugfs_create_file("default", 0444, domain_dir, NULL, &dfs_domain_ops);
	mutex_lock(&irq_domain_mutex);
	list_for_each_entry(d, &irq_domain_list, link)
		debugfs_add_domain_dir(d);
	mutex_unlock(&irq_domain_mutex);
}
#endif