irqdomain.c 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944
  1. #define pr_fmt(fmt) "irq: " fmt
  2. #include <linux/debugfs.h>
  3. #include <linux/hardirq.h>
  4. #include <linux/interrupt.h>
  5. #include <linux/irq.h>
  6. #include <linux/irqdesc.h>
  7. #include <linux/irqdomain.h>
  8. #include <linux/module.h>
  9. #include <linux/mutex.h>
  10. #include <linux/of.h>
  11. #include <linux/of_address.h>
  12. #include <linux/topology.h>
  13. #include <linux/seq_file.h>
  14. #include <linux/slab.h>
  15. #include <linux/smp.h>
  16. #include <linux/fs.h>
  17. #define IRQ_DOMAIN_MAP_LEGACY 0 /* driver allocated fixed range of irqs.
  18. * ie. legacy 8259, gets irqs 1..15 */
  19. #define IRQ_DOMAIN_MAP_NOMAP 1 /* no fast reverse mapping */
  20. #define IRQ_DOMAIN_MAP_LINEAR 2 /* linear map of interrupts */
  21. #define IRQ_DOMAIN_MAP_TREE 3 /* radix tree */
  22. static LIST_HEAD(irq_domain_list);
  23. static DEFINE_MUTEX(irq_domain_mutex);
  24. static DEFINE_MUTEX(revmap_trees_mutex);
  25. static struct irq_domain *irq_default_domain;
  26. /**
  27. * irq_domain_alloc() - Allocate a new irq_domain data structure
  28. * @of_node: optional device-tree node of the interrupt controller
  29. * @revmap_type: type of reverse mapping to use
  30. * @ops: map/unmap domain callbacks
  31. * @host_data: Controller private data pointer
  32. *
  33. * Allocates and initialize and irq_domain structure. Caller is expected to
  34. * register allocated irq_domain with irq_domain_register(). Returns pointer
  35. * to IRQ domain, or NULL on failure.
  36. */
  37. static struct irq_domain *irq_domain_alloc(struct device_node *of_node,
  38. unsigned int revmap_type,
  39. const struct irq_domain_ops *ops,
  40. void *host_data)
  41. {
  42. struct irq_domain *domain;
  43. domain = kzalloc_node(sizeof(*domain), GFP_KERNEL,
  44. of_node_to_nid(of_node));
  45. if (WARN_ON(!domain))
  46. return NULL;
  47. /* Fill structure */
  48. domain->revmap_type = revmap_type;
  49. domain->ops = ops;
  50. domain->host_data = host_data;
  51. domain->of_node = of_node_get(of_node);
  52. return domain;
  53. }
  54. static void irq_domain_free(struct irq_domain *domain)
  55. {
  56. of_node_put(domain->of_node);
  57. kfree(domain);
  58. }
  59. static void irq_domain_add(struct irq_domain *domain)
  60. {
  61. mutex_lock(&irq_domain_mutex);
  62. list_add(&domain->link, &irq_domain_list);
  63. mutex_unlock(&irq_domain_mutex);
  64. pr_debug("Allocated domain of type %d @0x%p\n",
  65. domain->revmap_type, domain);
  66. }
  67. /**
  68. * irq_domain_remove() - Remove an irq domain.
  69. * @domain: domain to remove
  70. *
  71. * This routine is used to remove an irq domain. The caller must ensure
  72. * that all mappings within the domain have been disposed of prior to
  73. * use, depending on the revmap type.
  74. */
  75. void irq_domain_remove(struct irq_domain *domain)
  76. {
  77. mutex_lock(&irq_domain_mutex);
  78. switch (domain->revmap_type) {
  79. case IRQ_DOMAIN_MAP_LEGACY:
  80. /*
  81. * Legacy domains don't manage their own irq_desc
  82. * allocations, we expect the caller to handle irq_desc
  83. * freeing on their own.
  84. */
  85. break;
  86. case IRQ_DOMAIN_MAP_TREE:
  87. /*
  88. * radix_tree_delete() takes care of destroying the root
  89. * node when all entries are removed. Shout if there are
  90. * any mappings left.
  91. */
  92. WARN_ON(domain->revmap_data.tree.height);
  93. break;
  94. case IRQ_DOMAIN_MAP_LINEAR:
  95. kfree(domain->revmap_data.linear.revmap);
  96. domain->revmap_data.linear.size = 0;
  97. break;
  98. case IRQ_DOMAIN_MAP_NOMAP:
  99. break;
  100. }
  101. list_del(&domain->link);
  102. /*
  103. * If the going away domain is the default one, reset it.
  104. */
  105. if (unlikely(irq_default_domain == domain))
  106. irq_set_default_host(NULL);
  107. mutex_unlock(&irq_domain_mutex);
  108. pr_debug("Removed domain of type %d @0x%p\n",
  109. domain->revmap_type, domain);
  110. irq_domain_free(domain);
  111. }
  112. EXPORT_SYMBOL_GPL(irq_domain_remove);
  113. static unsigned int irq_domain_legacy_revmap(struct irq_domain *domain,
  114. irq_hw_number_t hwirq)
  115. {
  116. irq_hw_number_t first_hwirq = domain->revmap_data.legacy.first_hwirq;
  117. int size = domain->revmap_data.legacy.size;
  118. if (WARN_ON(hwirq < first_hwirq || hwirq >= first_hwirq + size))
  119. return 0;
  120. return hwirq - first_hwirq + domain->revmap_data.legacy.first_irq;
  121. }
  122. /**
  123. * irq_domain_add_simple() - Allocate and register a simple irq_domain.
  124. * @of_node: pointer to interrupt controller's device tree node.
  125. * @size: total number of irqs in mapping
  126. * @first_irq: first number of irq block assigned to the domain,
  127. * pass zero to assign irqs on-the-fly. This will result in a
  128. * linear IRQ domain so it is important to use irq_create_mapping()
  129. * for each used IRQ, especially when SPARSE_IRQ is enabled.
  130. * @ops: map/unmap domain callbacks
  131. * @host_data: Controller private data pointer
  132. *
  133. * Allocates a legacy irq_domain if irq_base is positive or a linear
  134. * domain otherwise. For the legacy domain, IRQ descriptors will also
  135. * be allocated.
  136. *
  137. * This is intended to implement the expected behaviour for most
  138. * interrupt controllers which is that a linear mapping should
  139. * normally be used unless the system requires a legacy mapping in
  140. * order to support supplying interrupt numbers during non-DT
  141. * registration of devices.
  142. */
  143. struct irq_domain *irq_domain_add_simple(struct device_node *of_node,
  144. unsigned int size,
  145. unsigned int first_irq,
  146. const struct irq_domain_ops *ops,
  147. void *host_data)
  148. {
  149. if (first_irq > 0) {
  150. int irq_base;
  151. if (IS_ENABLED(CONFIG_SPARSE_IRQ)) {
  152. /*
  153. * Set the descriptor allocator to search for a
  154. * 1-to-1 mapping, such as irq_alloc_desc_at().
  155. * Use of_node_to_nid() which is defined to
  156. * numa_node_id() on platforms that have no custom
  157. * implementation.
  158. */
  159. irq_base = irq_alloc_descs(first_irq, first_irq, size,
  160. of_node_to_nid(of_node));
  161. if (irq_base < 0) {
  162. pr_info("Cannot allocate irq_descs @ IRQ%d, assuming pre-allocated\n",
  163. first_irq);
  164. irq_base = first_irq;
  165. }
  166. } else
  167. irq_base = first_irq;
  168. return irq_domain_add_legacy(of_node, size, irq_base, 0,
  169. ops, host_data);
  170. }
  171. /* A linear domain is the default */
  172. return irq_domain_add_linear(of_node, size, ops, host_data);
  173. }
  174. EXPORT_SYMBOL_GPL(irq_domain_add_simple);
  175. /**
  176. * irq_domain_add_legacy() - Allocate and register a legacy revmap irq_domain.
  177. * @of_node: pointer to interrupt controller's device tree node.
  178. * @size: total number of irqs in legacy mapping
  179. * @first_irq: first number of irq block assigned to the domain
  180. * @first_hwirq: first hwirq number to use for the translation. Should normally
  181. * be '0', but a positive integer can be used if the effective
  182. * hwirqs numbering does not begin at zero.
  183. * @ops: map/unmap domain callbacks
  184. * @host_data: Controller private data pointer
  185. *
  186. * Note: the map() callback will be called before this function returns
  187. * for all legacy interrupts except 0 (which is always the invalid irq for
  188. * a legacy controller).
  189. */
  190. struct irq_domain *irq_domain_add_legacy(struct device_node *of_node,
  191. unsigned int size,
  192. unsigned int first_irq,
  193. irq_hw_number_t first_hwirq,
  194. const struct irq_domain_ops *ops,
  195. void *host_data)
  196. {
  197. struct irq_domain *domain;
  198. unsigned int i;
  199. domain = irq_domain_alloc(of_node, IRQ_DOMAIN_MAP_LEGACY, ops, host_data);
  200. if (!domain)
  201. return NULL;
  202. domain->revmap_data.legacy.first_irq = first_irq;
  203. domain->revmap_data.legacy.first_hwirq = first_hwirq;
  204. domain->revmap_data.legacy.size = size;
  205. mutex_lock(&irq_domain_mutex);
  206. /* Verify that all the irqs are available */
  207. for (i = 0; i < size; i++) {
  208. int irq = first_irq + i;
  209. struct irq_data *irq_data = irq_get_irq_data(irq);
  210. if (WARN_ON(!irq_data || irq_data->domain)) {
  211. mutex_unlock(&irq_domain_mutex);
  212. irq_domain_free(domain);
  213. return NULL;
  214. }
  215. }
  216. /* Claim all of the irqs before registering a legacy domain */
  217. for (i = 0; i < size; i++) {
  218. struct irq_data *irq_data = irq_get_irq_data(first_irq + i);
  219. irq_data->hwirq = first_hwirq + i;
  220. irq_data->domain = domain;
  221. }
  222. mutex_unlock(&irq_domain_mutex);
  223. for (i = 0; i < size; i++) {
  224. int irq = first_irq + i;
  225. int hwirq = first_hwirq + i;
  226. /* IRQ0 gets ignored */
  227. if (!irq)
  228. continue;
  229. /* Legacy flags are left to default at this point,
  230. * one can then use irq_create_mapping() to
  231. * explicitly change them
  232. */
  233. if (ops->map)
  234. ops->map(domain, irq, hwirq);
  235. /* Clear norequest flags */
  236. irq_clear_status_flags(irq, IRQ_NOREQUEST);
  237. }
  238. irq_domain_add(domain);
  239. return domain;
  240. }
  241. EXPORT_SYMBOL_GPL(irq_domain_add_legacy);
  242. /**
  243. * irq_domain_add_linear() - Allocate and register a linear revmap irq_domain.
  244. * @of_node: pointer to interrupt controller's device tree node.
  245. * @size: Number of interrupts in the domain.
  246. * @ops: map/unmap domain callbacks
  247. * @host_data: Controller private data pointer
  248. */
  249. struct irq_domain *irq_domain_add_linear(struct device_node *of_node,
  250. unsigned int size,
  251. const struct irq_domain_ops *ops,
  252. void *host_data)
  253. {
  254. struct irq_domain *domain;
  255. unsigned int *revmap;
  256. revmap = kzalloc_node(sizeof(*revmap) * size, GFP_KERNEL,
  257. of_node_to_nid(of_node));
  258. if (WARN_ON(!revmap))
  259. return NULL;
  260. domain = irq_domain_alloc(of_node, IRQ_DOMAIN_MAP_LINEAR, ops, host_data);
  261. if (!domain) {
  262. kfree(revmap);
  263. return NULL;
  264. }
  265. domain->revmap_data.linear.size = size;
  266. domain->revmap_data.linear.revmap = revmap;
  267. irq_domain_add(domain);
  268. return domain;
  269. }
  270. EXPORT_SYMBOL_GPL(irq_domain_add_linear);
  271. struct irq_domain *irq_domain_add_nomap(struct device_node *of_node,
  272. unsigned int max_irq,
  273. const struct irq_domain_ops *ops,
  274. void *host_data)
  275. {
  276. struct irq_domain *domain = irq_domain_alloc(of_node,
  277. IRQ_DOMAIN_MAP_NOMAP, ops, host_data);
  278. if (domain) {
  279. domain->revmap_data.nomap.max_irq = max_irq ? max_irq : ~0;
  280. irq_domain_add(domain);
  281. }
  282. return domain;
  283. }
  284. EXPORT_SYMBOL_GPL(irq_domain_add_nomap);
  285. /**
  286. * irq_domain_add_tree()
  287. * @of_node: pointer to interrupt controller's device tree node.
  288. * @ops: map/unmap domain callbacks
  289. *
  290. * Note: The radix tree will be allocated later during boot automatically
  291. * (the reverse mapping will use the slow path until that happens).
  292. */
  293. struct irq_domain *irq_domain_add_tree(struct device_node *of_node,
  294. const struct irq_domain_ops *ops,
  295. void *host_data)
  296. {
  297. struct irq_domain *domain = irq_domain_alloc(of_node,
  298. IRQ_DOMAIN_MAP_TREE, ops, host_data);
  299. if (domain) {
  300. INIT_RADIX_TREE(&domain->revmap_data.tree, GFP_KERNEL);
  301. irq_domain_add(domain);
  302. }
  303. return domain;
  304. }
  305. EXPORT_SYMBOL_GPL(irq_domain_add_tree);
  306. /**
  307. * irq_find_host() - Locates a domain for a given device node
  308. * @node: device-tree node of the interrupt controller
  309. */
  310. struct irq_domain *irq_find_host(struct device_node *node)
  311. {
  312. struct irq_domain *h, *found = NULL;
  313. int rc;
  314. /* We might want to match the legacy controller last since
  315. * it might potentially be set to match all interrupts in
  316. * the absence of a device node. This isn't a problem so far
  317. * yet though...
  318. */
  319. mutex_lock(&irq_domain_mutex);
  320. list_for_each_entry(h, &irq_domain_list, link) {
  321. if (h->ops->match)
  322. rc = h->ops->match(h, node);
  323. else
  324. rc = (h->of_node != NULL) && (h->of_node == node);
  325. if (rc) {
  326. found = h;
  327. break;
  328. }
  329. }
  330. mutex_unlock(&irq_domain_mutex);
  331. return found;
  332. }
  333. EXPORT_SYMBOL_GPL(irq_find_host);
  334. /**
  335. * irq_set_default_host() - Set a "default" irq domain
  336. * @domain: default domain pointer
  337. *
  338. * For convenience, it's possible to set a "default" domain that will be used
  339. * whenever NULL is passed to irq_create_mapping(). It makes life easier for
  340. * platforms that want to manipulate a few hard coded interrupt numbers that
  341. * aren't properly represented in the device-tree.
  342. */
  343. void irq_set_default_host(struct irq_domain *domain)
  344. {
  345. pr_debug("Default domain set to @0x%p\n", domain);
  346. irq_default_domain = domain;
  347. }
  348. EXPORT_SYMBOL_GPL(irq_set_default_host);
  349. static void irq_domain_disassociate_many(struct irq_domain *domain,
  350. unsigned int irq_base, int count)
  351. {
  352. /*
  353. * disassociate in reverse order;
  354. * not strictly necessary, but nice for unwinding
  355. */
  356. while (count--) {
  357. int irq = irq_base + count;
  358. struct irq_data *irq_data = irq_get_irq_data(irq);
  359. irq_hw_number_t hwirq;
  360. if (WARN_ON(!irq_data || irq_data->domain != domain))
  361. continue;
  362. hwirq = irq_data->hwirq;
  363. irq_set_status_flags(irq, IRQ_NOREQUEST);
  364. /* remove chip and handler */
  365. irq_set_chip_and_handler(irq, NULL, NULL);
  366. /* Make sure it's completed */
  367. synchronize_irq(irq);
  368. /* Tell the PIC about it */
  369. if (domain->ops->unmap)
  370. domain->ops->unmap(domain, irq);
  371. smp_mb();
  372. irq_data->domain = NULL;
  373. irq_data->hwirq = 0;
  374. /* Clear reverse map */
  375. switch(domain->revmap_type) {
  376. case IRQ_DOMAIN_MAP_LINEAR:
  377. if (hwirq < domain->revmap_data.linear.size)
  378. domain->revmap_data.linear.revmap[hwirq] = 0;
  379. break;
  380. case IRQ_DOMAIN_MAP_TREE:
  381. mutex_lock(&revmap_trees_mutex);
  382. radix_tree_delete(&domain->revmap_data.tree, hwirq);
  383. mutex_unlock(&revmap_trees_mutex);
  384. break;
  385. }
  386. }
  387. }
  388. int irq_domain_associate_many(struct irq_domain *domain, unsigned int irq_base,
  389. irq_hw_number_t hwirq_base, int count)
  390. {
  391. unsigned int virq = irq_base;
  392. irq_hw_number_t hwirq = hwirq_base;
  393. int i, ret;
  394. pr_debug("%s(%s, irqbase=%i, hwbase=%i, count=%i)\n", __func__,
  395. of_node_full_name(domain->of_node), irq_base, (int)hwirq_base, count);
  396. for (i = 0; i < count; i++) {
  397. struct irq_data *irq_data = irq_get_irq_data(virq + i);
  398. if (WARN(!irq_data, "error: irq_desc not allocated; "
  399. "irq=%i hwirq=0x%x\n", virq + i, (int)hwirq + i))
  400. return -EINVAL;
  401. if (WARN(irq_data->domain, "error: irq_desc already associated; "
  402. "irq=%i hwirq=0x%x\n", virq + i, (int)hwirq + i))
  403. return -EINVAL;
  404. };
  405. for (i = 0; i < count; i++, virq++, hwirq++) {
  406. struct irq_data *irq_data = irq_get_irq_data(virq);
  407. irq_data->hwirq = hwirq;
  408. irq_data->domain = domain;
  409. if (domain->ops->map) {
  410. ret = domain->ops->map(domain, virq, hwirq);
  411. if (ret != 0) {
  412. /*
  413. * If map() returns -EPERM, this interrupt is protected
  414. * by the firmware or some other service and shall not
  415. * be mapped.
  416. *
  417. * Since on some platforms we blindly try to map everything
  418. * we end up with a log full of backtraces.
  419. *
  420. * So instead, we silently fail on -EPERM, it is the
  421. * responsibility of the PIC driver to display a relevant
  422. * message if needed.
  423. */
  424. if (ret != -EPERM) {
  425. pr_err("irq-%i==>hwirq-0x%lx mapping failed: %d\n",
  426. virq, hwirq, ret);
  427. WARN_ON(1);
  428. }
  429. irq_data->domain = NULL;
  430. irq_data->hwirq = 0;
  431. goto err_unmap;
  432. }
  433. }
  434. switch (domain->revmap_type) {
  435. case IRQ_DOMAIN_MAP_LINEAR:
  436. if (hwirq < domain->revmap_data.linear.size)
  437. domain->revmap_data.linear.revmap[hwirq] = virq;
  438. break;
  439. case IRQ_DOMAIN_MAP_TREE:
  440. mutex_lock(&revmap_trees_mutex);
  441. radix_tree_insert(&domain->revmap_data.tree, hwirq, irq_data);
  442. mutex_unlock(&revmap_trees_mutex);
  443. break;
  444. }
  445. irq_clear_status_flags(virq, IRQ_NOREQUEST);
  446. }
  447. return 0;
  448. err_unmap:
  449. irq_domain_disassociate_many(domain, irq_base, i);
  450. return -EINVAL;
  451. }
  452. EXPORT_SYMBOL_GPL(irq_domain_associate_many);
  453. /**
  454. * irq_create_direct_mapping() - Allocate an irq for direct mapping
  455. * @domain: domain to allocate the irq for or NULL for default domain
  456. *
  457. * This routine is used for irq controllers which can choose the hardware
  458. * interrupt numbers they generate. In such a case it's simplest to use
  459. * the linux irq as the hardware interrupt number.
  460. */
  461. unsigned int irq_create_direct_mapping(struct irq_domain *domain)
  462. {
  463. unsigned int virq;
  464. if (domain == NULL)
  465. domain = irq_default_domain;
  466. if (WARN_ON(!domain || domain->revmap_type != IRQ_DOMAIN_MAP_NOMAP))
  467. return 0;
  468. virq = irq_alloc_desc_from(1, of_node_to_nid(domain->of_node));
  469. if (!virq) {
  470. pr_debug("create_direct virq allocation failed\n");
  471. return 0;
  472. }
  473. if (virq >= domain->revmap_data.nomap.max_irq) {
  474. pr_err("ERROR: no free irqs available below %i maximum\n",
  475. domain->revmap_data.nomap.max_irq);
  476. irq_free_desc(virq);
  477. return 0;
  478. }
  479. pr_debug("create_direct obtained virq %d\n", virq);
  480. if (irq_domain_associate(domain, virq, virq)) {
  481. irq_free_desc(virq);
  482. return 0;
  483. }
  484. return virq;
  485. }
  486. EXPORT_SYMBOL_GPL(irq_create_direct_mapping);
  487. /**
  488. * irq_create_mapping() - Map a hardware interrupt into linux irq space
  489. * @domain: domain owning this hardware interrupt or NULL for default domain
  490. * @hwirq: hardware irq number in that domain space
  491. *
  492. * Only one mapping per hardware interrupt is permitted. Returns a linux
  493. * irq number.
  494. * If the sense/trigger is to be specified, set_irq_type() should be called
  495. * on the number returned from that call.
  496. */
  497. unsigned int irq_create_mapping(struct irq_domain *domain,
  498. irq_hw_number_t hwirq)
  499. {
  500. unsigned int hint;
  501. int virq;
  502. pr_debug("irq_create_mapping(0x%p, 0x%lx)\n", domain, hwirq);
  503. /* Look for default domain if nececssary */
  504. if (domain == NULL)
  505. domain = irq_default_domain;
  506. if (domain == NULL) {
  507. pr_warning("irq_create_mapping called for"
  508. " NULL domain, hwirq=%lx\n", hwirq);
  509. WARN_ON(1);
  510. return 0;
  511. }
  512. pr_debug("-> using domain @%p\n", domain);
  513. /* Check if mapping already exists */
  514. virq = irq_find_mapping(domain, hwirq);
  515. if (virq) {
  516. pr_debug("-> existing mapping on virq %d\n", virq);
  517. return virq;
  518. }
  519. /* Get a virtual interrupt number */
  520. if (domain->revmap_type == IRQ_DOMAIN_MAP_LEGACY)
  521. return irq_domain_legacy_revmap(domain, hwirq);
  522. /* Allocate a virtual interrupt number */
  523. hint = hwirq % nr_irqs;
  524. if (hint == 0)
  525. hint++;
  526. virq = irq_alloc_desc_from(hint, of_node_to_nid(domain->of_node));
  527. if (virq <= 0)
  528. virq = irq_alloc_desc_from(1, of_node_to_nid(domain->of_node));
  529. if (virq <= 0) {
  530. pr_debug("-> virq allocation failed\n");
  531. return 0;
  532. }
  533. if (irq_domain_associate(domain, virq, hwirq)) {
  534. irq_free_desc(virq);
  535. return 0;
  536. }
  537. pr_debug("irq %lu on domain %s mapped to virtual irq %u\n",
  538. hwirq, of_node_full_name(domain->of_node), virq);
  539. return virq;
  540. }
  541. EXPORT_SYMBOL_GPL(irq_create_mapping);
  542. /**
  543. * irq_create_strict_mappings() - Map a range of hw irqs to fixed linux irqs
  544. * @domain: domain owning the interrupt range
  545. * @irq_base: beginning of linux IRQ range
  546. * @hwirq_base: beginning of hardware IRQ range
  547. * @count: Number of interrupts to map
  548. *
  549. * This routine is used for allocating and mapping a range of hardware
  550. * irqs to linux irqs where the linux irq numbers are at pre-defined
  551. * locations. For use by controllers that already have static mappings
  552. * to insert in to the domain.
  553. *
  554. * Non-linear users can use irq_create_identity_mapping() for IRQ-at-a-time
  555. * domain insertion.
  556. *
  557. * 0 is returned upon success, while any failure to establish a static
  558. * mapping is treated as an error.
  559. */
  560. int irq_create_strict_mappings(struct irq_domain *domain, unsigned int irq_base,
  561. irq_hw_number_t hwirq_base, int count)
  562. {
  563. int ret;
  564. ret = irq_alloc_descs(irq_base, irq_base, count,
  565. of_node_to_nid(domain->of_node));
  566. if (unlikely(ret < 0))
  567. return ret;
  568. ret = irq_domain_associate_many(domain, irq_base, hwirq_base, count);
  569. if (unlikely(ret < 0)) {
  570. irq_free_descs(irq_base, count);
  571. return ret;
  572. }
  573. return 0;
  574. }
  575. EXPORT_SYMBOL_GPL(irq_create_strict_mappings);
  576. unsigned int irq_create_of_mapping(struct device_node *controller,
  577. const u32 *intspec, unsigned int intsize)
  578. {
  579. struct irq_domain *domain;
  580. irq_hw_number_t hwirq;
  581. unsigned int type = IRQ_TYPE_NONE;
  582. unsigned int virq;
  583. domain = controller ? irq_find_host(controller) : irq_default_domain;
  584. if (!domain) {
  585. #ifdef CONFIG_MIPS
  586. /*
  587. * Workaround to avoid breaking interrupt controller drivers
  588. * that don't yet register an irq_domain. This is temporary
  589. * code. ~~~gcl, Feb 24, 2012
  590. *
  591. * Scheduled for removal in Linux v3.6. That should be enough
  592. * time.
  593. */
  594. if (intsize > 0)
  595. return intspec[0];
  596. #endif
  597. pr_warning("no irq domain found for %s !\n",
  598. of_node_full_name(controller));
  599. return 0;
  600. }
  601. /* If domain has no translation, then we assume interrupt line */
  602. if (domain->ops->xlate == NULL)
  603. hwirq = intspec[0];
  604. else {
  605. if (domain->ops->xlate(domain, controller, intspec, intsize,
  606. &hwirq, &type))
  607. return 0;
  608. }
  609. /* Create mapping */
  610. virq = irq_create_mapping(domain, hwirq);
  611. if (!virq)
  612. return virq;
  613. /* Set type if specified and different than the current one */
  614. if (type != IRQ_TYPE_NONE &&
  615. type != (irqd_get_trigger_type(irq_get_irq_data(virq))))
  616. irq_set_irq_type(virq, type);
  617. return virq;
  618. }
  619. EXPORT_SYMBOL_GPL(irq_create_of_mapping);
  620. /**
  621. * irq_dispose_mapping() - Unmap an interrupt
  622. * @virq: linux irq number of the interrupt to unmap
  623. */
  624. void irq_dispose_mapping(unsigned int virq)
  625. {
  626. struct irq_data *irq_data = irq_get_irq_data(virq);
  627. struct irq_domain *domain;
  628. if (!virq || !irq_data)
  629. return;
  630. domain = irq_data->domain;
  631. if (WARN_ON(domain == NULL))
  632. return;
  633. /* Never unmap legacy interrupts */
  634. if (domain->revmap_type == IRQ_DOMAIN_MAP_LEGACY)
  635. return;
  636. irq_domain_disassociate_many(domain, virq, 1);
  637. irq_free_desc(virq);
  638. }
  639. EXPORT_SYMBOL_GPL(irq_dispose_mapping);
  640. /**
  641. * irq_find_mapping() - Find a linux irq from an hw irq number.
  642. * @domain: domain owning this hardware interrupt
  643. * @hwirq: hardware irq number in that domain space
  644. */
  645. unsigned int irq_find_mapping(struct irq_domain *domain,
  646. irq_hw_number_t hwirq)
  647. {
  648. struct irq_data *data;
  649. /* Look for default domain if nececssary */
  650. if (domain == NULL)
  651. domain = irq_default_domain;
  652. if (domain == NULL)
  653. return 0;
  654. switch (domain->revmap_type) {
  655. case IRQ_DOMAIN_MAP_LEGACY:
  656. return irq_domain_legacy_revmap(domain, hwirq);
  657. case IRQ_DOMAIN_MAP_LINEAR:
  658. return irq_linear_revmap(domain, hwirq);
  659. case IRQ_DOMAIN_MAP_TREE:
  660. rcu_read_lock();
  661. data = radix_tree_lookup(&domain->revmap_data.tree, hwirq);
  662. rcu_read_unlock();
  663. if (data)
  664. return data->irq;
  665. break;
  666. case IRQ_DOMAIN_MAP_NOMAP:
  667. data = irq_get_irq_data(hwirq);
  668. if (data && (data->domain == domain) && (data->hwirq == hwirq))
  669. return hwirq;
  670. break;
  671. }
  672. return 0;
  673. }
  674. EXPORT_SYMBOL_GPL(irq_find_mapping);
  675. /**
  676. * irq_linear_revmap() - Find a linux irq from a hw irq number.
  677. * @domain: domain owning this hardware interrupt
  678. * @hwirq: hardware irq number in that domain space
  679. *
  680. * This is a fast path that can be called directly by irq controller code to
  681. * save a handful of instructions.
  682. */
  683. unsigned int irq_linear_revmap(struct irq_domain *domain,
  684. irq_hw_number_t hwirq)
  685. {
  686. BUG_ON(domain->revmap_type != IRQ_DOMAIN_MAP_LINEAR);
  687. /* Check revmap bounds; complain if exceeded */
  688. if (WARN_ON(hwirq >= domain->revmap_data.linear.size))
  689. return 0;
  690. return domain->revmap_data.linear.revmap[hwirq];
  691. }
  692. EXPORT_SYMBOL_GPL(irq_linear_revmap);
  693. #ifdef CONFIG_IRQ_DOMAIN_DEBUG
  694. static int virq_debug_show(struct seq_file *m, void *private)
  695. {
  696. unsigned long flags;
  697. struct irq_desc *desc;
  698. const char *p;
  699. static const char none[] = "none";
  700. void *data;
  701. int i;
  702. seq_printf(m, "%-5s %-7s %-15s %-*s %s\n", "irq", "hwirq",
  703. "chip name", (int)(2 * sizeof(void *) + 2), "chip data",
  704. "domain name");
  705. for (i = 1; i < nr_irqs; i++) {
  706. desc = irq_to_desc(i);
  707. if (!desc)
  708. continue;
  709. raw_spin_lock_irqsave(&desc->lock, flags);
  710. if (desc->action && desc->action->handler) {
  711. struct irq_chip *chip;
  712. seq_printf(m, "%5d ", i);
  713. seq_printf(m, "0x%05lx ", desc->irq_data.hwirq);
  714. chip = irq_desc_get_chip(desc);
  715. if (chip && chip->name)
  716. p = chip->name;
  717. else
  718. p = none;
  719. seq_printf(m, "%-15s ", p);
  720. data = irq_desc_get_chip_data(desc);
  721. seq_printf(m, data ? "0x%p " : " %p ", data);
  722. if (desc->irq_data.domain)
  723. p = of_node_full_name(desc->irq_data.domain->of_node);
  724. else
  725. p = none;
  726. seq_printf(m, "%s\n", p);
  727. }
  728. raw_spin_unlock_irqrestore(&desc->lock, flags);
  729. }
  730. return 0;
  731. }
  732. static int virq_debug_open(struct inode *inode, struct file *file)
  733. {
  734. return single_open(file, virq_debug_show, inode->i_private);
  735. }
  736. static const struct file_operations virq_debug_fops = {
  737. .open = virq_debug_open,
  738. .read = seq_read,
  739. .llseek = seq_lseek,
  740. .release = single_release,
  741. };
  742. static int __init irq_debugfs_init(void)
  743. {
  744. if (debugfs_create_file("irq_domain_mapping", S_IRUGO, NULL,
  745. NULL, &virq_debug_fops) == NULL)
  746. return -ENOMEM;
  747. return 0;
  748. }
  749. __initcall(irq_debugfs_init);
  750. #endif /* CONFIG_IRQ_DOMAIN_DEBUG */
  751. /**
  752. * irq_domain_xlate_onecell() - Generic xlate for direct one cell bindings
  753. *
  754. * Device Tree IRQ specifier translation function which works with one cell
  755. * bindings where the cell value maps directly to the hwirq number.
  756. */
  757. int irq_domain_xlate_onecell(struct irq_domain *d, struct device_node *ctrlr,
  758. const u32 *intspec, unsigned int intsize,
  759. unsigned long *out_hwirq, unsigned int *out_type)
  760. {
  761. if (WARN_ON(intsize < 1))
  762. return -EINVAL;
  763. *out_hwirq = intspec[0];
  764. *out_type = IRQ_TYPE_NONE;
  765. return 0;
  766. }
  767. EXPORT_SYMBOL_GPL(irq_domain_xlate_onecell);
  768. /**
  769. * irq_domain_xlate_twocell() - Generic xlate for direct two cell bindings
  770. *
  771. * Device Tree IRQ specifier translation function which works with two cell
  772. * bindings where the cell values map directly to the hwirq number
  773. * and linux irq flags.
  774. */
  775. int irq_domain_xlate_twocell(struct irq_domain *d, struct device_node *ctrlr,
  776. const u32 *intspec, unsigned int intsize,
  777. irq_hw_number_t *out_hwirq, unsigned int *out_type)
  778. {
  779. if (WARN_ON(intsize < 2))
  780. return -EINVAL;
  781. *out_hwirq = intspec[0];
  782. *out_type = intspec[1] & IRQ_TYPE_SENSE_MASK;
  783. return 0;
  784. }
  785. EXPORT_SYMBOL_GPL(irq_domain_xlate_twocell);
  786. /**
  787. * irq_domain_xlate_onetwocell() - Generic xlate for one or two cell bindings
  788. *
  789. * Device Tree IRQ specifier translation function which works with either one
  790. * or two cell bindings where the cell values map directly to the hwirq number
  791. * and linux irq flags.
  792. *
  793. * Note: don't use this function unless your interrupt controller explicitly
  794. * supports both one and two cell bindings. For the majority of controllers
  795. * the _onecell() or _twocell() variants above should be used.
  796. */
  797. int irq_domain_xlate_onetwocell(struct irq_domain *d,
  798. struct device_node *ctrlr,
  799. const u32 *intspec, unsigned int intsize,
  800. unsigned long *out_hwirq, unsigned int *out_type)
  801. {
  802. if (WARN_ON(intsize < 1))
  803. return -EINVAL;
  804. *out_hwirq = intspec[0];
  805. *out_type = (intsize > 1) ? intspec[1] : IRQ_TYPE_NONE;
  806. return 0;
  807. }
  808. EXPORT_SYMBOL_GPL(irq_domain_xlate_onetwocell);
  809. const struct irq_domain_ops irq_domain_simple_ops = {
  810. .xlate = irq_domain_xlate_onetwocell,
  811. };
  812. EXPORT_SYMBOL_GPL(irq_domain_simple_ops);
  813. #ifdef CONFIG_OF_IRQ
  814. void irq_domain_generate_simple(const struct of_device_id *match,
  815. u64 phys_base, unsigned int irq_start)
  816. {
  817. struct device_node *node;
  818. pr_debug("looking for phys_base=%llx, irq_start=%i\n",
  819. (unsigned long long) phys_base, (int) irq_start);
  820. node = of_find_matching_node_by_address(NULL, match, phys_base);
  821. if (node)
  822. irq_domain_add_legacy(node, 32, irq_start, 0,
  823. &irq_domain_simple_ops, NULL);
  824. }
  825. EXPORT_SYMBOL_GPL(irq_domain_generate_simple);
  826. #endif