manage.c 43 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659
  1. /*
  2. * linux/kernel/irq/manage.c
  3. *
  4. * Copyright (C) 1992, 1998-2006 Linus Torvalds, Ingo Molnar
  5. * Copyright (C) 2005-2006 Thomas Gleixner
  6. *
  7. * This file contains driver APIs to the irq subsystem.
  8. */
  9. #include <linux/irq.h>
  10. #include <linux/kthread.h>
  11. #include <linux/module.h>
  12. #include <linux/random.h>
  13. #include <linux/interrupt.h>
  14. #include <linux/slab.h>
  15. #include <linux/sched.h>
  16. #include "internals.h"
  17. #ifdef CONFIG_IRQ_FORCED_THREADING
  18. __read_mostly bool force_irqthreads;
  19. static int __init setup_forced_irqthreads(char *arg)
  20. {
  21. force_irqthreads = true;
  22. return 0;
  23. }
  24. early_param("threadirqs", setup_forced_irqthreads);
  25. #endif
  26. /**
  27. * synchronize_irq - wait for pending IRQ handlers (on other CPUs)
  28. * @irq: interrupt number to wait for
  29. *
  30. * This function waits for any pending IRQ handlers for this interrupt
  31. * to complete before returning. If you use this function while
  32. * holding a resource the IRQ handler may need you will deadlock.
  33. *
  34. * This function may be called - with care - from IRQ context.
  35. */
  36. void synchronize_irq(unsigned int irq)
  37. {
  38. struct irq_desc *desc = irq_to_desc(irq);
  39. bool inprogress;
  40. if (!desc)
  41. return;
  42. do {
  43. unsigned long flags;
  44. /*
  45. * Wait until we're out of the critical section. This might
  46. * give the wrong answer due to the lack of memory barriers.
  47. */
  48. while (irqd_irq_inprogress(&desc->irq_data))
  49. cpu_relax();
  50. /* Ok, that indicated we're done: double-check carefully. */
  51. raw_spin_lock_irqsave(&desc->lock, flags);
  52. inprogress = irqd_irq_inprogress(&desc->irq_data);
  53. raw_spin_unlock_irqrestore(&desc->lock, flags);
  54. /* Oops, that failed? */
  55. } while (inprogress);
  56. /*
  57. * We made sure that no hardirq handler is running. Now verify
  58. * that no threaded handlers are active.
  59. */
  60. wait_event(desc->wait_for_threads, !atomic_read(&desc->threads_active));
  61. }
  62. EXPORT_SYMBOL(synchronize_irq);
  63. #ifdef CONFIG_SMP
  64. cpumask_var_t irq_default_affinity;
  65. /**
  66. * irq_can_set_affinity - Check if the affinity of a given irq can be set
  67. * @irq: Interrupt to check
  68. *
  69. */
  70. int irq_can_set_affinity(unsigned int irq)
  71. {
  72. struct irq_desc *desc = irq_to_desc(irq);
  73. if (!desc || !irqd_can_balance(&desc->irq_data) ||
  74. !desc->irq_data.chip || !desc->irq_data.chip->irq_set_affinity)
  75. return 0;
  76. return 1;
  77. }
  78. /**
  79. * irq_set_thread_affinity - Notify irq threads to adjust affinity
  80. * @desc: irq descriptor which has affitnity changed
  81. *
  82. * We just set IRQTF_AFFINITY and delegate the affinity setting
  83. * to the interrupt thread itself. We can not call
  84. * set_cpus_allowed_ptr() here as we hold desc->lock and this
  85. * code can be called from hard interrupt context.
  86. */
  87. void irq_set_thread_affinity(struct irq_desc *desc)
  88. {
  89. struct irqaction *action = desc->action;
  90. while (action) {
  91. if (action->thread)
  92. set_bit(IRQTF_AFFINITY, &action->thread_flags);
  93. action = action->next;
  94. }
  95. }
  96. #ifdef CONFIG_GENERIC_PENDING_IRQ
  97. static inline bool irq_can_move_pcntxt(struct irq_data *data)
  98. {
  99. return irqd_can_move_in_process_context(data);
  100. }
  101. static inline bool irq_move_pending(struct irq_data *data)
  102. {
  103. return irqd_is_setaffinity_pending(data);
  104. }
  105. static inline void
  106. irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask)
  107. {
  108. cpumask_copy(desc->pending_mask, mask);
  109. }
  110. static inline void
  111. irq_get_pending(struct cpumask *mask, struct irq_desc *desc)
  112. {
  113. cpumask_copy(mask, desc->pending_mask);
  114. }
  115. #else
  116. static inline bool irq_can_move_pcntxt(struct irq_data *data) { return true; }
  117. static inline bool irq_move_pending(struct irq_data *data) { return false; }
  118. static inline void
  119. irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask) { }
  120. static inline void
  121. irq_get_pending(struct cpumask *mask, struct irq_desc *desc) { }
  122. #endif
  123. int __irq_set_affinity_locked(struct irq_data *data, const struct cpumask *mask)
  124. {
  125. struct irq_chip *chip = irq_data_get_irq_chip(data);
  126. struct irq_desc *desc = irq_data_to_desc(data);
  127. int ret = 0;
  128. if (!chip || !chip->irq_set_affinity)
  129. return -EINVAL;
  130. if (irq_can_move_pcntxt(data)) {
  131. ret = chip->irq_set_affinity(data, mask, false);
  132. switch (ret) {
  133. case IRQ_SET_MASK_OK:
  134. cpumask_copy(data->affinity, mask);
  135. case IRQ_SET_MASK_OK_NOCOPY:
  136. irq_set_thread_affinity(desc);
  137. ret = 0;
  138. }
  139. } else {
  140. irqd_set_move_pending(data);
  141. irq_copy_pending(desc, mask);
  142. }
  143. if (desc->affinity_notify) {
  144. kref_get(&desc->affinity_notify->kref);
  145. schedule_work(&desc->affinity_notify->work);
  146. }
  147. irqd_set(data, IRQD_AFFINITY_SET);
  148. return ret;
  149. }
  150. /**
  151. * irq_set_affinity - Set the irq affinity of a given irq
  152. * @irq: Interrupt to set affinity
  153. * @mask: cpumask
  154. *
  155. */
  156. int irq_set_affinity(unsigned int irq, const struct cpumask *mask)
  157. {
  158. struct irq_desc *desc = irq_to_desc(irq);
  159. unsigned long flags;
  160. int ret;
  161. if (!desc)
  162. return -EINVAL;
  163. raw_spin_lock_irqsave(&desc->lock, flags);
  164. ret = __irq_set_affinity_locked(irq_desc_get_irq_data(desc), mask);
  165. raw_spin_unlock_irqrestore(&desc->lock, flags);
  166. return ret;
  167. }
  168. int irq_set_affinity_hint(unsigned int irq, const struct cpumask *m)
  169. {
  170. unsigned long flags;
  171. struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
  172. if (!desc)
  173. return -EINVAL;
  174. desc->affinity_hint = m;
  175. irq_put_desc_unlock(desc, flags);
  176. return 0;
  177. }
  178. EXPORT_SYMBOL_GPL(irq_set_affinity_hint);
  179. static void irq_affinity_notify(struct work_struct *work)
  180. {
  181. struct irq_affinity_notify *notify =
  182. container_of(work, struct irq_affinity_notify, work);
  183. struct irq_desc *desc = irq_to_desc(notify->irq);
  184. cpumask_var_t cpumask;
  185. unsigned long flags;
  186. if (!desc || !alloc_cpumask_var(&cpumask, GFP_KERNEL))
  187. goto out;
  188. raw_spin_lock_irqsave(&desc->lock, flags);
  189. if (irq_move_pending(&desc->irq_data))
  190. irq_get_pending(cpumask, desc);
  191. else
  192. cpumask_copy(cpumask, desc->irq_data.affinity);
  193. raw_spin_unlock_irqrestore(&desc->lock, flags);
  194. notify->notify(notify, cpumask);
  195. free_cpumask_var(cpumask);
  196. out:
  197. kref_put(&notify->kref, notify->release);
  198. }
  199. /**
  200. * irq_set_affinity_notifier - control notification of IRQ affinity changes
  201. * @irq: Interrupt for which to enable/disable notification
  202. * @notify: Context for notification, or %NULL to disable
  203. * notification. Function pointers must be initialised;
  204. * the other fields will be initialised by this function.
  205. *
  206. * Must be called in process context. Notification may only be enabled
  207. * after the IRQ is allocated and must be disabled before the IRQ is
  208. * freed using free_irq().
  209. */
  210. int
  211. irq_set_affinity_notifier(unsigned int irq, struct irq_affinity_notify *notify)
  212. {
  213. struct irq_desc *desc = irq_to_desc(irq);
  214. struct irq_affinity_notify *old_notify;
  215. unsigned long flags;
  216. /* The release function is promised process context */
  217. might_sleep();
  218. if (!desc)
  219. return -EINVAL;
  220. /* Complete initialisation of *notify */
  221. if (notify) {
  222. notify->irq = irq;
  223. kref_init(&notify->kref);
  224. INIT_WORK(&notify->work, irq_affinity_notify);
  225. }
  226. raw_spin_lock_irqsave(&desc->lock, flags);
  227. old_notify = desc->affinity_notify;
  228. desc->affinity_notify = notify;
  229. raw_spin_unlock_irqrestore(&desc->lock, flags);
  230. if (old_notify)
  231. kref_put(&old_notify->kref, old_notify->release);
  232. return 0;
  233. }
  234. EXPORT_SYMBOL_GPL(irq_set_affinity_notifier);
  235. #ifndef CONFIG_AUTO_IRQ_AFFINITY
  236. /*
  237. * Generic version of the affinity autoselector.
  238. */
  239. static int
  240. setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask)
  241. {
  242. struct irq_chip *chip = irq_desc_get_chip(desc);
  243. struct cpumask *set = irq_default_affinity;
  244. int ret, node = desc->irq_data.node;
  245. /* Excludes PER_CPU and NO_BALANCE interrupts */
  246. if (!irq_can_set_affinity(irq))
  247. return 0;
  248. /*
  249. * Preserve an userspace affinity setup, but make sure that
  250. * one of the targets is online.
  251. */
  252. if (irqd_has_set(&desc->irq_data, IRQD_AFFINITY_SET)) {
  253. if (cpumask_intersects(desc->irq_data.affinity,
  254. cpu_online_mask))
  255. set = desc->irq_data.affinity;
  256. else
  257. irqd_clear(&desc->irq_data, IRQD_AFFINITY_SET);
  258. }
  259. cpumask_and(mask, cpu_online_mask, set);
  260. if (node != NUMA_NO_NODE) {
  261. const struct cpumask *nodemask = cpumask_of_node(node);
  262. /* make sure at least one of the cpus in nodemask is online */
  263. if (cpumask_intersects(mask, nodemask))
  264. cpumask_and(mask, mask, nodemask);
  265. }
  266. ret = chip->irq_set_affinity(&desc->irq_data, mask, false);
  267. switch (ret) {
  268. case IRQ_SET_MASK_OK:
  269. cpumask_copy(desc->irq_data.affinity, mask);
  270. case IRQ_SET_MASK_OK_NOCOPY:
  271. irq_set_thread_affinity(desc);
  272. }
  273. return 0;
  274. }
  275. #else
  276. static inline int
  277. setup_affinity(unsigned int irq, struct irq_desc *d, struct cpumask *mask)
  278. {
  279. return irq_select_affinity(irq);
  280. }
  281. #endif
  282. /*
  283. * Called when affinity is set via /proc/irq
  284. */
  285. int irq_select_affinity_usr(unsigned int irq, struct cpumask *mask)
  286. {
  287. struct irq_desc *desc = irq_to_desc(irq);
  288. unsigned long flags;
  289. int ret;
  290. raw_spin_lock_irqsave(&desc->lock, flags);
  291. ret = setup_affinity(irq, desc, mask);
  292. raw_spin_unlock_irqrestore(&desc->lock, flags);
  293. return ret;
  294. }
  295. #else
  296. static inline int
  297. setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask)
  298. {
  299. return 0;
  300. }
  301. #endif
  302. void __disable_irq(struct irq_desc *desc, unsigned int irq, bool suspend)
  303. {
  304. if (suspend) {
  305. if (!desc->action || (desc->action->flags & IRQF_NO_SUSPEND))
  306. return;
  307. desc->istate |= IRQS_SUSPENDED;
  308. }
  309. if (!desc->depth++)
  310. irq_disable(desc);
  311. }
  312. static int __disable_irq_nosync(unsigned int irq)
  313. {
  314. unsigned long flags;
  315. struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
  316. if (!desc)
  317. return -EINVAL;
  318. __disable_irq(desc, irq, false);
  319. irq_put_desc_busunlock(desc, flags);
  320. return 0;
  321. }
  322. /**
  323. * disable_irq_nosync - disable an irq without waiting
  324. * @irq: Interrupt to disable
  325. *
  326. * Disable the selected interrupt line. Disables and Enables are
  327. * nested.
  328. * Unlike disable_irq(), this function does not ensure existing
  329. * instances of the IRQ handler have completed before returning.
  330. *
  331. * This function may be called from IRQ context.
  332. */
  333. void disable_irq_nosync(unsigned int irq)
  334. {
  335. __disable_irq_nosync(irq);
  336. }
  337. EXPORT_SYMBOL(disable_irq_nosync);
  338. /**
  339. * disable_irq - disable an irq and wait for completion
  340. * @irq: Interrupt to disable
  341. *
  342. * Disable the selected interrupt line. Enables and Disables are
  343. * nested.
  344. * This function waits for any pending IRQ handlers for this interrupt
  345. * to complete before returning. If you use this function while
  346. * holding a resource the IRQ handler may need you will deadlock.
  347. *
  348. * This function may be called - with care - from IRQ context.
  349. */
  350. void disable_irq(unsigned int irq)
  351. {
  352. if (!__disable_irq_nosync(irq))
  353. synchronize_irq(irq);
  354. }
  355. EXPORT_SYMBOL(disable_irq);
  356. void __enable_irq(struct irq_desc *desc, unsigned int irq, bool resume)
  357. {
  358. if (resume) {
  359. if (!(desc->istate & IRQS_SUSPENDED)) {
  360. if (!desc->action)
  361. return;
  362. if (!(desc->action->flags & IRQF_FORCE_RESUME))
  363. return;
  364. /* Pretend that it got disabled ! */
  365. desc->depth++;
  366. }
  367. desc->istate &= ~IRQS_SUSPENDED;
  368. }
  369. switch (desc->depth) {
  370. case 0:
  371. err_out:
  372. WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n", irq);
  373. break;
  374. case 1: {
  375. if (desc->istate & IRQS_SUSPENDED)
  376. goto err_out;
  377. /* Prevent probing on this irq: */
  378. irq_settings_set_noprobe(desc);
  379. irq_enable(desc);
  380. check_irq_resend(desc, irq);
  381. /* fall-through */
  382. }
  383. default:
  384. desc->depth--;
  385. }
  386. }
  387. /**
  388. * enable_irq - enable handling of an irq
  389. * @irq: Interrupt to enable
  390. *
  391. * Undoes the effect of one call to disable_irq(). If this
  392. * matches the last disable, processing of interrupts on this
  393. * IRQ line is re-enabled.
  394. *
  395. * This function may be called from IRQ context only when
  396. * desc->irq_data.chip->bus_lock and desc->chip->bus_sync_unlock are NULL !
  397. */
  398. void enable_irq(unsigned int irq)
  399. {
  400. unsigned long flags;
  401. struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
  402. if (!desc)
  403. return;
  404. if (WARN(!desc->irq_data.chip,
  405. KERN_ERR "enable_irq before setup/request_irq: irq %u\n", irq))
  406. goto out;
  407. __enable_irq(desc, irq, false);
  408. out:
  409. irq_put_desc_busunlock(desc, flags);
  410. }
  411. EXPORT_SYMBOL(enable_irq);
  412. static int set_irq_wake_real(unsigned int irq, unsigned int on)
  413. {
  414. struct irq_desc *desc = irq_to_desc(irq);
  415. int ret = -ENXIO;
  416. if (irq_desc_get_chip(desc)->flags & IRQCHIP_SKIP_SET_WAKE)
  417. return 0;
  418. if (desc->irq_data.chip->irq_set_wake)
  419. ret = desc->irq_data.chip->irq_set_wake(&desc->irq_data, on);
  420. return ret;
  421. }
  422. /**
  423. * irq_set_irq_wake - control irq power management wakeup
  424. * @irq: interrupt to control
  425. * @on: enable/disable power management wakeup
  426. *
  427. * Enable/disable power management wakeup mode, which is
  428. * disabled by default. Enables and disables must match,
  429. * just as they match for non-wakeup mode support.
  430. *
  431. * Wakeup mode lets this IRQ wake the system from sleep
  432. * states like "suspend to RAM".
  433. */
  434. int irq_set_irq_wake(unsigned int irq, unsigned int on)
  435. {
  436. unsigned long flags;
  437. struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
  438. int ret = 0;
  439. if (!desc)
  440. return -EINVAL;
  441. /* wakeup-capable irqs can be shared between drivers that
  442. * don't need to have the same sleep mode behaviors.
  443. */
  444. if (on) {
  445. if (desc->wake_depth++ == 0) {
  446. ret = set_irq_wake_real(irq, on);
  447. if (ret)
  448. desc->wake_depth = 0;
  449. else
  450. irqd_set(&desc->irq_data, IRQD_WAKEUP_STATE);
  451. }
  452. } else {
  453. if (desc->wake_depth == 0) {
  454. WARN(1, "Unbalanced IRQ %d wake disable\n", irq);
  455. } else if (--desc->wake_depth == 0) {
  456. ret = set_irq_wake_real(irq, on);
  457. if (ret)
  458. desc->wake_depth = 1;
  459. else
  460. irqd_clear(&desc->irq_data, IRQD_WAKEUP_STATE);
  461. }
  462. }
  463. irq_put_desc_busunlock(desc, flags);
  464. return ret;
  465. }
  466. EXPORT_SYMBOL(irq_set_irq_wake);
  467. /*
  468. * Internal function that tells the architecture code whether a
  469. * particular irq has been exclusively allocated or is available
  470. * for driver use.
  471. */
  472. int can_request_irq(unsigned int irq, unsigned long irqflags)
  473. {
  474. unsigned long flags;
  475. struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
  476. int canrequest = 0;
  477. if (!desc)
  478. return 0;
  479. if (irq_settings_can_request(desc)) {
  480. if (desc->action)
  481. if (irqflags & desc->action->flags & IRQF_SHARED)
  482. canrequest =1;
  483. }
  484. irq_put_desc_unlock(desc, flags);
  485. return canrequest;
  486. }
  487. int __irq_set_trigger(struct irq_desc *desc, unsigned int irq,
  488. unsigned long flags)
  489. {
  490. struct irq_chip *chip = desc->irq_data.chip;
  491. int ret, unmask = 0;
  492. if (!chip || !chip->irq_set_type) {
  493. /*
  494. * IRQF_TRIGGER_* but the PIC does not support multiple
  495. * flow-types?
  496. */
  497. pr_debug("genirq: No set_type function for IRQ %d (%s)\n", irq,
  498. chip ? (chip->name ? : "unknown") : "unknown");
  499. return 0;
  500. }
  501. flags &= IRQ_TYPE_SENSE_MASK;
  502. if (chip->flags & IRQCHIP_SET_TYPE_MASKED) {
  503. if (!irqd_irq_masked(&desc->irq_data))
  504. mask_irq(desc);
  505. if (!irqd_irq_disabled(&desc->irq_data))
  506. unmask = 1;
  507. }
  508. /* caller masked out all except trigger mode flags */
  509. ret = chip->irq_set_type(&desc->irq_data, flags);
  510. switch (ret) {
  511. case IRQ_SET_MASK_OK:
  512. irqd_clear(&desc->irq_data, IRQD_TRIGGER_MASK);
  513. irqd_set(&desc->irq_data, flags);
  514. case IRQ_SET_MASK_OK_NOCOPY:
  515. flags = irqd_get_trigger_type(&desc->irq_data);
  516. irq_settings_set_trigger_mask(desc, flags);
  517. irqd_clear(&desc->irq_data, IRQD_LEVEL);
  518. irq_settings_clr_level(desc);
  519. if (flags & IRQ_TYPE_LEVEL_MASK) {
  520. irq_settings_set_level(desc);
  521. irqd_set(&desc->irq_data, IRQD_LEVEL);
  522. }
  523. ret = 0;
  524. break;
  525. default:
  526. pr_err("genirq: Setting trigger mode %lu for irq %u failed (%pF)\n",
  527. flags, irq, chip->irq_set_type);
  528. }
  529. if (unmask)
  530. unmask_irq(desc);
  531. return ret;
  532. }
  533. /*
  534. * Default primary interrupt handler for threaded interrupts. Is
  535. * assigned as primary handler when request_threaded_irq is called
  536. * with handler == NULL. Useful for oneshot interrupts.
  537. */
  538. static irqreturn_t irq_default_primary_handler(int irq, void *dev_id)
  539. {
  540. return IRQ_WAKE_THREAD;
  541. }
  542. /*
  543. * Primary handler for nested threaded interrupts. Should never be
  544. * called.
  545. */
  546. static irqreturn_t irq_nested_primary_handler(int irq, void *dev_id)
  547. {
  548. WARN(1, "Primary handler called for nested irq %d\n", irq);
  549. return IRQ_NONE;
  550. }
  551. static int irq_wait_for_interrupt(struct irqaction *action)
  552. {
  553. set_current_state(TASK_INTERRUPTIBLE);
  554. while (!kthread_should_stop()) {
  555. if (test_and_clear_bit(IRQTF_RUNTHREAD,
  556. &action->thread_flags)) {
  557. __set_current_state(TASK_RUNNING);
  558. return 0;
  559. }
  560. schedule();
  561. set_current_state(TASK_INTERRUPTIBLE);
  562. }
  563. __set_current_state(TASK_RUNNING);
  564. return -1;
  565. }
  566. /*
  567. * Oneshot interrupts keep the irq line masked until the threaded
  568. * handler finished. unmask if the interrupt has not been disabled and
  569. * is marked MASKED.
  570. */
  571. static void irq_finalize_oneshot(struct irq_desc *desc,
  572. struct irqaction *action)
  573. {
  574. if (!(desc->istate & IRQS_ONESHOT))
  575. return;
  576. again:
  577. chip_bus_lock(desc);
  578. raw_spin_lock_irq(&desc->lock);
  579. /*
  580. * Implausible though it may be we need to protect us against
  581. * the following scenario:
  582. *
  583. * The thread is faster done than the hard interrupt handler
  584. * on the other CPU. If we unmask the irq line then the
  585. * interrupt can come in again and masks the line, leaves due
  586. * to IRQS_INPROGRESS and the irq line is masked forever.
  587. *
  588. * This also serializes the state of shared oneshot handlers
  589. * versus "desc->threads_onehsot |= action->thread_mask;" in
  590. * irq_wake_thread(). See the comment there which explains the
  591. * serialization.
  592. */
  593. if (unlikely(irqd_irq_inprogress(&desc->irq_data))) {
  594. raw_spin_unlock_irq(&desc->lock);
  595. chip_bus_sync_unlock(desc);
  596. cpu_relax();
  597. goto again;
  598. }
  599. /*
  600. * Now check again, whether the thread should run. Otherwise
  601. * we would clear the threads_oneshot bit of this thread which
  602. * was just set.
  603. */
  604. if (test_bit(IRQTF_RUNTHREAD, &action->thread_flags))
  605. goto out_unlock;
  606. desc->threads_oneshot &= ~action->thread_mask;
  607. if (!desc->threads_oneshot && !irqd_irq_disabled(&desc->irq_data) &&
  608. irqd_irq_masked(&desc->irq_data))
  609. unmask_irq(desc);
  610. out_unlock:
  611. raw_spin_unlock_irq(&desc->lock);
  612. chip_bus_sync_unlock(desc);
  613. }
  614. #ifdef CONFIG_SMP
  615. /*
  616. * Check whether we need to chasnge the affinity of the interrupt thread.
  617. */
  618. static void
  619. irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action)
  620. {
  621. cpumask_var_t mask;
  622. if (!test_and_clear_bit(IRQTF_AFFINITY, &action->thread_flags))
  623. return;
  624. /*
  625. * In case we are out of memory we set IRQTF_AFFINITY again and
  626. * try again next time
  627. */
  628. if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
  629. set_bit(IRQTF_AFFINITY, &action->thread_flags);
  630. return;
  631. }
  632. raw_spin_lock_irq(&desc->lock);
  633. cpumask_copy(mask, desc->irq_data.affinity);
  634. raw_spin_unlock_irq(&desc->lock);
  635. set_cpus_allowed_ptr(current, mask);
  636. free_cpumask_var(mask);
  637. }
  638. #else
  639. static inline void
  640. irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) { }
  641. #endif
  642. /*
  643. * Interrupts which are not explicitely requested as threaded
  644. * interrupts rely on the implicit bh/preempt disable of the hard irq
  645. * context. So we need to disable bh here to avoid deadlocks and other
  646. * side effects.
  647. */
  648. static irqreturn_t
  649. irq_forced_thread_fn(struct irq_desc *desc, struct irqaction *action)
  650. {
  651. irqreturn_t ret;
  652. local_bh_disable();
  653. ret = action->thread_fn(action->irq, action->dev_id);
  654. irq_finalize_oneshot(desc, action);
  655. local_bh_enable();
  656. return ret;
  657. }
  658. /*
  659. * Interrupts explicitely requested as threaded interupts want to be
  660. * preemtible - many of them need to sleep and wait for slow busses to
  661. * complete.
  662. */
  663. static irqreturn_t irq_thread_fn(struct irq_desc *desc,
  664. struct irqaction *action)
  665. {
  666. irqreturn_t ret;
  667. ret = action->thread_fn(action->irq, action->dev_id);
  668. irq_finalize_oneshot(desc, action);
  669. return ret;
  670. }
  671. static void wake_threads_waitq(struct irq_desc *desc)
  672. {
  673. if (atomic_dec_and_test(&desc->threads_active) &&
  674. waitqueue_active(&desc->wait_for_threads))
  675. wake_up(&desc->wait_for_threads);
  676. }
  677. /*
  678. * Interrupt handler thread
  679. */
  680. static int irq_thread(void *data)
  681. {
  682. static const struct sched_param param = {
  683. .sched_priority = MAX_USER_RT_PRIO/2,
  684. };
  685. struct irqaction *action = data;
  686. struct irq_desc *desc = irq_to_desc(action->irq);
  687. irqreturn_t (*handler_fn)(struct irq_desc *desc,
  688. struct irqaction *action);
  689. if (force_irqthreads && test_bit(IRQTF_FORCED_THREAD,
  690. &action->thread_flags))
  691. handler_fn = irq_forced_thread_fn;
  692. else
  693. handler_fn = irq_thread_fn;
  694. sched_setscheduler(current, SCHED_FIFO, &param);
  695. current->irq_thread = 1;
  696. while (!irq_wait_for_interrupt(action)) {
  697. irqreturn_t action_ret;
  698. irq_thread_check_affinity(desc, action);
  699. action_ret = handler_fn(desc, action);
  700. if (!noirqdebug)
  701. note_interrupt(action->irq, desc, action_ret);
  702. wake_threads_waitq(desc);
  703. }
  704. /*
  705. * This is the regular exit path. __free_irq() is stopping the
  706. * thread via kthread_stop() after calling
  707. * synchronize_irq(). So neither IRQTF_RUNTHREAD nor the
  708. * oneshot mask bit can be set. We cannot verify that as we
  709. * cannot touch the oneshot mask at this point anymore as
  710. * __setup_irq() might have given out currents thread_mask
  711. * again.
  712. *
  713. * Clear irq_thread. Otherwise exit_irq_thread() would make
  714. * fuzz about an active irq thread going into nirvana.
  715. */
  716. current->irq_thread = 0;
  717. return 0;
  718. }
  719. /*
  720. * Called from do_exit()
  721. */
  722. void exit_irq_thread(void)
  723. {
  724. struct task_struct *tsk = current;
  725. struct irq_desc *desc;
  726. struct irqaction *action;
  727. if (!tsk->irq_thread)
  728. return;
  729. action = kthread_data(tsk);
  730. pr_err("genirq: exiting task \"%s\" (%d) is an active IRQ thread (irq %d)\n",
  731. tsk->comm ? tsk->comm : "", tsk->pid, action->irq);
  732. desc = irq_to_desc(action->irq);
  733. /*
  734. * If IRQTF_RUNTHREAD is set, we need to decrement
  735. * desc->threads_active and wake possible waiters.
  736. */
  737. if (test_and_clear_bit(IRQTF_RUNTHREAD, &action->thread_flags))
  738. wake_threads_waitq(desc);
  739. /* Prevent a stale desc->threads_oneshot */
  740. irq_finalize_oneshot(desc, action);
  741. }
  742. static void irq_setup_forced_threading(struct irqaction *new)
  743. {
  744. if (!force_irqthreads)
  745. return;
  746. if (new->flags & (IRQF_NO_THREAD | IRQF_PERCPU | IRQF_ONESHOT))
  747. return;
  748. new->flags |= IRQF_ONESHOT;
  749. if (!new->thread_fn) {
  750. set_bit(IRQTF_FORCED_THREAD, &new->thread_flags);
  751. new->thread_fn = new->handler;
  752. new->handler = irq_default_primary_handler;
  753. }
  754. }
  755. /*
  756. * Internal function to register an irqaction - typically used to
  757. * allocate special interrupts that are part of the architecture.
  758. */
  759. static int
  760. __setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new)
  761. {
  762. struct irqaction *old, **old_ptr;
  763. unsigned long flags, thread_mask = 0;
  764. int ret, nested, shared = 0;
  765. cpumask_var_t mask;
  766. if (!desc)
  767. return -EINVAL;
  768. if (desc->irq_data.chip == &no_irq_chip)
  769. return -ENOSYS;
  770. if (!try_module_get(desc->owner))
  771. return -ENODEV;
  772. /*
  773. * Some drivers like serial.c use request_irq() heavily,
  774. * so we have to be careful not to interfere with a
  775. * running system.
  776. */
  777. if (new->flags & IRQF_SAMPLE_RANDOM) {
  778. /*
  779. * This function might sleep, we want to call it first,
  780. * outside of the atomic block.
  781. * Yes, this might clear the entropy pool if the wrong
  782. * driver is attempted to be loaded, without actually
  783. * installing a new handler, but is this really a problem,
  784. * only the sysadmin is able to do this.
  785. */
  786. rand_initialize_irq(irq);
  787. }
  788. /*
  789. * Check whether the interrupt nests into another interrupt
  790. * thread.
  791. */
  792. nested = irq_settings_is_nested_thread(desc);
  793. if (nested) {
  794. if (!new->thread_fn) {
  795. ret = -EINVAL;
  796. goto out_mput;
  797. }
  798. /*
  799. * Replace the primary handler which was provided from
  800. * the driver for non nested interrupt handling by the
  801. * dummy function which warns when called.
  802. */
  803. new->handler = irq_nested_primary_handler;
  804. } else {
  805. if (irq_settings_can_thread(desc))
  806. irq_setup_forced_threading(new);
  807. }
  808. /*
  809. * Create a handler thread when a thread function is supplied
  810. * and the interrupt does not nest into another interrupt
  811. * thread.
  812. */
  813. if (new->thread_fn && !nested) {
  814. struct task_struct *t;
  815. t = kthread_create(irq_thread, new, "irq/%d-%s", irq,
  816. new->name);
  817. if (IS_ERR(t)) {
  818. ret = PTR_ERR(t);
  819. goto out_mput;
  820. }
  821. /*
  822. * We keep the reference to the task struct even if
  823. * the thread dies to avoid that the interrupt code
  824. * references an already freed task_struct.
  825. */
  826. get_task_struct(t);
  827. new->thread = t;
  828. }
  829. if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
  830. ret = -ENOMEM;
  831. goto out_thread;
  832. }
  833. /*
  834. * The following block of code has to be executed atomically
  835. */
  836. raw_spin_lock_irqsave(&desc->lock, flags);
  837. old_ptr = &desc->action;
  838. old = *old_ptr;
  839. if (old) {
  840. /*
  841. * Can't share interrupts unless both agree to and are
  842. * the same type (level, edge, polarity). So both flag
  843. * fields must have IRQF_SHARED set and the bits which
  844. * set the trigger type must match. Also all must
  845. * agree on ONESHOT.
  846. */
  847. if (!((old->flags & new->flags) & IRQF_SHARED) ||
  848. ((old->flags ^ new->flags) & IRQF_TRIGGER_MASK) ||
  849. ((old->flags ^ new->flags) & IRQF_ONESHOT))
  850. goto mismatch;
  851. /* All handlers must agree on per-cpuness */
  852. if ((old->flags & IRQF_PERCPU) !=
  853. (new->flags & IRQF_PERCPU))
  854. goto mismatch;
  855. /* add new interrupt at end of irq queue */
  856. do {
  857. /*
  858. * Or all existing action->thread_mask bits,
  859. * so we can find the next zero bit for this
  860. * new action.
  861. */
  862. thread_mask |= old->thread_mask;
  863. old_ptr = &old->next;
  864. old = *old_ptr;
  865. } while (old);
  866. shared = 1;
  867. }
  868. /*
  869. * Setup the thread mask for this irqaction for ONESHOT. For
  870. * !ONESHOT irqs the thread mask is 0 so we can avoid a
  871. * conditional in irq_wake_thread().
  872. */
  873. if (new->flags & IRQF_ONESHOT) {
  874. /*
  875. * Unlikely to have 32 resp 64 irqs sharing one line,
  876. * but who knows.
  877. */
  878. if (thread_mask == ~0UL) {
  879. ret = -EBUSY;
  880. goto out_mask;
  881. }
  882. /*
  883. * The thread_mask for the action is or'ed to
  884. * desc->thread_active to indicate that the
  885. * IRQF_ONESHOT thread handler has been woken, but not
  886. * yet finished. The bit is cleared when a thread
  887. * completes. When all threads of a shared interrupt
  888. * line have completed desc->threads_active becomes
  889. * zero and the interrupt line is unmasked. See
  890. * handle.c:irq_wake_thread() for further information.
  891. *
  892. * If no thread is woken by primary (hard irq context)
  893. * interrupt handlers, then desc->threads_active is
  894. * also checked for zero to unmask the irq line in the
  895. * affected hard irq flow handlers
  896. * (handle_[fasteoi|level]_irq).
  897. *
  898. * The new action gets the first zero bit of
  899. * thread_mask assigned. See the loop above which or's
  900. * all existing action->thread_mask bits.
  901. */
  902. new->thread_mask = 1 << ffz(thread_mask);
  903. } else if (new->handler == irq_default_primary_handler) {
  904. /*
  905. * The interrupt was requested with handler = NULL, so
  906. * we use the default primary handler for it. But it
  907. * does not have the oneshot flag set. In combination
  908. * with level interrupts this is deadly, because the
  909. * default primary handler just wakes the thread, then
  910. * the irq lines is reenabled, but the device still
  911. * has the level irq asserted. Rinse and repeat....
  912. *
  913. * While this works for edge type interrupts, we play
  914. * it safe and reject unconditionally because we can't
  915. * say for sure which type this interrupt really
  916. * has. The type flags are unreliable as the
  917. * underlying chip implementation can override them.
  918. */
  919. pr_err("genirq: Threaded irq requested with handler=NULL and !ONESHOT for irq %d\n",
  920. irq);
  921. ret = -EINVAL;
  922. goto out_mask;
  923. }
  924. if (!shared) {
  925. init_waitqueue_head(&desc->wait_for_threads);
  926. /* Setup the type (level, edge polarity) if configured: */
  927. if (new->flags & IRQF_TRIGGER_MASK) {
  928. ret = __irq_set_trigger(desc, irq,
  929. new->flags & IRQF_TRIGGER_MASK);
  930. if (ret)
  931. goto out_mask;
  932. }
  933. desc->istate &= ~(IRQS_AUTODETECT | IRQS_SPURIOUS_DISABLED | \
  934. IRQS_ONESHOT | IRQS_WAITING);
  935. irqd_clear(&desc->irq_data, IRQD_IRQ_INPROGRESS);
  936. if (new->flags & IRQF_PERCPU) {
  937. irqd_set(&desc->irq_data, IRQD_PER_CPU);
  938. irq_settings_set_per_cpu(desc);
  939. }
  940. if (new->flags & IRQF_ONESHOT)
  941. desc->istate |= IRQS_ONESHOT;
  942. if (irq_settings_can_autoenable(desc))
  943. irq_startup(desc, true);
  944. else
  945. /* Undo nested disables: */
  946. desc->depth = 1;
  947. /* Exclude IRQ from balancing if requested */
  948. if (new->flags & IRQF_NOBALANCING) {
  949. irq_settings_set_no_balancing(desc);
  950. irqd_set(&desc->irq_data, IRQD_NO_BALANCING);
  951. }
  952. /* Set default affinity mask once everything is setup */
  953. setup_affinity(irq, desc, mask);
  954. } else if (new->flags & IRQF_TRIGGER_MASK) {
  955. unsigned int nmsk = new->flags & IRQF_TRIGGER_MASK;
  956. unsigned int omsk = irq_settings_get_trigger_mask(desc);
  957. if (nmsk != omsk)
  958. /* hope the handler works with current trigger mode */
  959. pr_warning("genirq: irq %d uses trigger mode %u; requested %u\n",
  960. irq, nmsk, omsk);
  961. }
  962. new->irq = irq;
  963. *old_ptr = new;
  964. /* Reset broken irq detection when installing new handler */
  965. desc->irq_count = 0;
  966. desc->irqs_unhandled = 0;
  967. /*
  968. * Check whether we disabled the irq via the spurious handler
  969. * before. Reenable it and give it another chance.
  970. */
  971. if (shared && (desc->istate & IRQS_SPURIOUS_DISABLED)) {
  972. desc->istate &= ~IRQS_SPURIOUS_DISABLED;
  973. __enable_irq(desc, irq, false);
  974. }
  975. raw_spin_unlock_irqrestore(&desc->lock, flags);
  976. /*
  977. * Strictly no need to wake it up, but hung_task complains
  978. * when no hard interrupt wakes the thread up.
  979. */
  980. if (new->thread)
  981. wake_up_process(new->thread);
  982. register_irq_proc(irq, desc);
  983. new->dir = NULL;
  984. register_handler_proc(irq, new);
  985. free_cpumask_var(mask);
  986. return 0;
  987. mismatch:
  988. if (!(new->flags & IRQF_PROBE_SHARED)) {
  989. pr_err("genirq: Flags mismatch irq %d. %08x (%s) vs. %08x (%s)\n",
  990. irq, new->flags, new->name, old->flags, old->name);
  991. #ifdef CONFIG_DEBUG_SHIRQ
  992. dump_stack();
  993. #endif
  994. }
  995. ret = -EBUSY;
  996. out_mask:
  997. raw_spin_unlock_irqrestore(&desc->lock, flags);
  998. free_cpumask_var(mask);
  999. out_thread:
  1000. if (new->thread) {
  1001. struct task_struct *t = new->thread;
  1002. new->thread = NULL;
  1003. kthread_stop(t);
  1004. put_task_struct(t);
  1005. }
  1006. out_mput:
  1007. module_put(desc->owner);
  1008. return ret;
  1009. }
  1010. /**
  1011. * setup_irq - setup an interrupt
  1012. * @irq: Interrupt line to setup
  1013. * @act: irqaction for the interrupt
  1014. *
  1015. * Used to statically setup interrupts in the early boot process.
  1016. */
  1017. int setup_irq(unsigned int irq, struct irqaction *act)
  1018. {
  1019. int retval;
  1020. struct irq_desc *desc = irq_to_desc(irq);
  1021. if (WARN_ON(irq_settings_is_per_cpu_devid(desc)))
  1022. return -EINVAL;
  1023. chip_bus_lock(desc);
  1024. retval = __setup_irq(irq, desc, act);
  1025. chip_bus_sync_unlock(desc);
  1026. return retval;
  1027. }
  1028. EXPORT_SYMBOL_GPL(setup_irq);
  1029. /*
  1030. * Internal function to unregister an irqaction - used to free
  1031. * regular and special interrupts that are part of the architecture.
  1032. */
  1033. static struct irqaction *__free_irq(unsigned int irq, void *dev_id)
  1034. {
  1035. struct irq_desc *desc = irq_to_desc(irq);
  1036. struct irqaction *action, **action_ptr;
  1037. unsigned long flags;
  1038. WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
  1039. if (!desc)
  1040. return NULL;
  1041. raw_spin_lock_irqsave(&desc->lock, flags);
  1042. /*
  1043. * There can be multiple actions per IRQ descriptor, find the right
  1044. * one based on the dev_id:
  1045. */
  1046. action_ptr = &desc->action;
  1047. for (;;) {
  1048. action = *action_ptr;
  1049. if (!action) {
  1050. WARN(1, "Trying to free already-free IRQ %d\n", irq);
  1051. raw_spin_unlock_irqrestore(&desc->lock, flags);
  1052. return NULL;
  1053. }
  1054. if (action->dev_id == dev_id)
  1055. break;
  1056. action_ptr = &action->next;
  1057. }
  1058. /* Found it - now remove it from the list of entries: */
  1059. *action_ptr = action->next;
  1060. /* Currently used only by UML, might disappear one day: */
  1061. #ifdef CONFIG_IRQ_RELEASE_METHOD
  1062. if (desc->irq_data.chip->release)
  1063. desc->irq_data.chip->release(irq, dev_id);
  1064. #endif
  1065. /* If this was the last handler, shut down the IRQ line: */
  1066. if (!desc->action)
  1067. irq_shutdown(desc);
  1068. #ifdef CONFIG_SMP
  1069. /* make sure affinity_hint is cleaned up */
  1070. if (WARN_ON_ONCE(desc->affinity_hint))
  1071. desc->affinity_hint = NULL;
  1072. #endif
  1073. raw_spin_unlock_irqrestore(&desc->lock, flags);
  1074. unregister_handler_proc(irq, action);
  1075. /* Make sure it's not being used on another CPU: */
  1076. synchronize_irq(irq);
  1077. #ifdef CONFIG_DEBUG_SHIRQ
  1078. /*
  1079. * It's a shared IRQ -- the driver ought to be prepared for an IRQ
  1080. * event to happen even now it's being freed, so let's make sure that
  1081. * is so by doing an extra call to the handler ....
  1082. *
  1083. * ( We do this after actually deregistering it, to make sure that a
  1084. * 'real' IRQ doesn't run in * parallel with our fake. )
  1085. */
  1086. if (action->flags & IRQF_SHARED) {
  1087. local_irq_save(flags);
  1088. action->handler(irq, dev_id);
  1089. local_irq_restore(flags);
  1090. }
  1091. #endif
  1092. if (action->thread) {
  1093. kthread_stop(action->thread);
  1094. put_task_struct(action->thread);
  1095. }
  1096. module_put(desc->owner);
  1097. return action;
  1098. }
  1099. /**
  1100. * remove_irq - free an interrupt
  1101. * @irq: Interrupt line to free
  1102. * @act: irqaction for the interrupt
  1103. *
  1104. * Used to remove interrupts statically setup by the early boot process.
  1105. */
  1106. void remove_irq(unsigned int irq, struct irqaction *act)
  1107. {
  1108. struct irq_desc *desc = irq_to_desc(irq);
  1109. if (desc && !WARN_ON(irq_settings_is_per_cpu_devid(desc)))
  1110. __free_irq(irq, act->dev_id);
  1111. }
  1112. EXPORT_SYMBOL_GPL(remove_irq);
  1113. /**
  1114. * free_irq - free an interrupt allocated with request_irq
  1115. * @irq: Interrupt line to free
  1116. * @dev_id: Device identity to free
  1117. *
  1118. * Remove an interrupt handler. The handler is removed and if the
  1119. * interrupt line is no longer in use by any driver it is disabled.
  1120. * On a shared IRQ the caller must ensure the interrupt is disabled
  1121. * on the card it drives before calling this function. The function
  1122. * does not return until any executing interrupts for this IRQ
  1123. * have completed.
  1124. *
  1125. * This function must not be called from interrupt context.
  1126. */
  1127. void free_irq(unsigned int irq, void *dev_id)
  1128. {
  1129. struct irq_desc *desc = irq_to_desc(irq);
  1130. if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
  1131. return;
  1132. #ifdef CONFIG_SMP
  1133. if (WARN_ON(desc->affinity_notify))
  1134. desc->affinity_notify = NULL;
  1135. #endif
  1136. chip_bus_lock(desc);
  1137. kfree(__free_irq(irq, dev_id));
  1138. chip_bus_sync_unlock(desc);
  1139. }
  1140. EXPORT_SYMBOL(free_irq);
  1141. /**
  1142. * request_threaded_irq - allocate an interrupt line
  1143. * @irq: Interrupt line to allocate
  1144. * @handler: Function to be called when the IRQ occurs.
  1145. * Primary handler for threaded interrupts
  1146. * If NULL and thread_fn != NULL the default
  1147. * primary handler is installed
  1148. * @thread_fn: Function called from the irq handler thread
  1149. * If NULL, no irq thread is created
  1150. * @irqflags: Interrupt type flags
  1151. * @devname: An ascii name for the claiming device
  1152. * @dev_id: A cookie passed back to the handler function
  1153. *
  1154. * This call allocates interrupt resources and enables the
  1155. * interrupt line and IRQ handling. From the point this
  1156. * call is made your handler function may be invoked. Since
  1157. * your handler function must clear any interrupt the board
  1158. * raises, you must take care both to initialise your hardware
  1159. * and to set up the interrupt handler in the right order.
  1160. *
  1161. * If you want to set up a threaded irq handler for your device
  1162. * then you need to supply @handler and @thread_fn. @handler is
  1163. * still called in hard interrupt context and has to check
  1164. * whether the interrupt originates from the device. If yes it
  1165. * needs to disable the interrupt on the device and return
  1166. * IRQ_WAKE_THREAD which will wake up the handler thread and run
  1167. * @thread_fn. This split handler design is necessary to support
  1168. * shared interrupts.
  1169. *
  1170. * Dev_id must be globally unique. Normally the address of the
  1171. * device data structure is used as the cookie. Since the handler
  1172. * receives this value it makes sense to use it.
  1173. *
  1174. * If your interrupt is shared you must pass a non NULL dev_id
  1175. * as this is required when freeing the interrupt.
  1176. *
  1177. * Flags:
  1178. *
  1179. * IRQF_SHARED Interrupt is shared
  1180. * IRQF_SAMPLE_RANDOM The interrupt can be used for entropy
  1181. * IRQF_TRIGGER_* Specify active edge(s) or level
  1182. *
  1183. */
  1184. int request_threaded_irq(unsigned int irq, irq_handler_t handler,
  1185. irq_handler_t thread_fn, unsigned long irqflags,
  1186. const char *devname, void *dev_id)
  1187. {
  1188. struct irqaction *action;
  1189. struct irq_desc *desc;
  1190. int retval;
  1191. /*
  1192. * Sanity-check: shared interrupts must pass in a real dev-ID,
  1193. * otherwise we'll have trouble later trying to figure out
  1194. * which interrupt is which (messes up the interrupt freeing
  1195. * logic etc).
  1196. */
  1197. if ((irqflags & IRQF_SHARED) && !dev_id)
  1198. return -EINVAL;
  1199. desc = irq_to_desc(irq);
  1200. if (!desc)
  1201. return -EINVAL;
  1202. if (!irq_settings_can_request(desc) ||
  1203. WARN_ON(irq_settings_is_per_cpu_devid(desc)))
  1204. return -EINVAL;
  1205. if (!handler) {
  1206. if (!thread_fn)
  1207. return -EINVAL;
  1208. handler = irq_default_primary_handler;
  1209. }
  1210. action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
  1211. if (!action)
  1212. return -ENOMEM;
  1213. action->handler = handler;
  1214. action->thread_fn = thread_fn;
  1215. action->flags = irqflags;
  1216. action->name = devname;
  1217. action->dev_id = dev_id;
  1218. chip_bus_lock(desc);
  1219. retval = __setup_irq(irq, desc, action);
  1220. chip_bus_sync_unlock(desc);
  1221. if (retval)
  1222. kfree(action);
  1223. #ifdef CONFIG_DEBUG_SHIRQ_FIXME
  1224. if (!retval && (irqflags & IRQF_SHARED)) {
  1225. /*
  1226. * It's a shared IRQ -- the driver ought to be prepared for it
  1227. * to happen immediately, so let's make sure....
  1228. * We disable the irq to make sure that a 'real' IRQ doesn't
  1229. * run in parallel with our fake.
  1230. */
  1231. unsigned long flags;
  1232. disable_irq(irq);
  1233. local_irq_save(flags);
  1234. handler(irq, dev_id);
  1235. local_irq_restore(flags);
  1236. enable_irq(irq);
  1237. }
  1238. #endif
  1239. return retval;
  1240. }
  1241. EXPORT_SYMBOL(request_threaded_irq);
  1242. /**
  1243. * request_any_context_irq - allocate an interrupt line
  1244. * @irq: Interrupt line to allocate
  1245. * @handler: Function to be called when the IRQ occurs.
  1246. * Threaded handler for threaded interrupts.
  1247. * @flags: Interrupt type flags
  1248. * @name: An ascii name for the claiming device
  1249. * @dev_id: A cookie passed back to the handler function
  1250. *
  1251. * This call allocates interrupt resources and enables the
  1252. * interrupt line and IRQ handling. It selects either a
  1253. * hardirq or threaded handling method depending on the
  1254. * context.
  1255. *
  1256. * On failure, it returns a negative value. On success,
  1257. * it returns either IRQC_IS_HARDIRQ or IRQC_IS_NESTED.
  1258. */
  1259. int request_any_context_irq(unsigned int irq, irq_handler_t handler,
  1260. unsigned long flags, const char *name, void *dev_id)
  1261. {
  1262. struct irq_desc *desc = irq_to_desc(irq);
  1263. int ret;
  1264. if (!desc)
  1265. return -EINVAL;
  1266. if (irq_settings_is_nested_thread(desc)) {
  1267. ret = request_threaded_irq(irq, NULL, handler,
  1268. flags, name, dev_id);
  1269. return !ret ? IRQC_IS_NESTED : ret;
  1270. }
  1271. ret = request_irq(irq, handler, flags, name, dev_id);
  1272. return !ret ? IRQC_IS_HARDIRQ : ret;
  1273. }
  1274. EXPORT_SYMBOL_GPL(request_any_context_irq);
  1275. void enable_percpu_irq(unsigned int irq, unsigned int type)
  1276. {
  1277. unsigned int cpu = smp_processor_id();
  1278. unsigned long flags;
  1279. struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
  1280. if (!desc)
  1281. return;
  1282. type &= IRQ_TYPE_SENSE_MASK;
  1283. if (type != IRQ_TYPE_NONE) {
  1284. int ret;
  1285. ret = __irq_set_trigger(desc, irq, type);
  1286. if (ret) {
  1287. WARN(1, "failed to set type for IRQ%d\n", irq);
  1288. goto out;
  1289. }
  1290. }
  1291. irq_percpu_enable(desc, cpu);
  1292. out:
  1293. irq_put_desc_unlock(desc, flags);
  1294. }
  1295. void disable_percpu_irq(unsigned int irq)
  1296. {
  1297. unsigned int cpu = smp_processor_id();
  1298. unsigned long flags;
  1299. struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
  1300. if (!desc)
  1301. return;
  1302. irq_percpu_disable(desc, cpu);
  1303. irq_put_desc_unlock(desc, flags);
  1304. }
  1305. /*
  1306. * Internal function to unregister a percpu irqaction.
  1307. */
  1308. static struct irqaction *__free_percpu_irq(unsigned int irq, void __percpu *dev_id)
  1309. {
  1310. struct irq_desc *desc = irq_to_desc(irq);
  1311. struct irqaction *action;
  1312. unsigned long flags;
  1313. WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
  1314. if (!desc)
  1315. return NULL;
  1316. raw_spin_lock_irqsave(&desc->lock, flags);
  1317. action = desc->action;
  1318. if (!action || action->percpu_dev_id != dev_id) {
  1319. WARN(1, "Trying to free already-free IRQ %d\n", irq);
  1320. goto bad;
  1321. }
  1322. if (!cpumask_empty(desc->percpu_enabled)) {
  1323. WARN(1, "percpu IRQ %d still enabled on CPU%d!\n",
  1324. irq, cpumask_first(desc->percpu_enabled));
  1325. goto bad;
  1326. }
  1327. /* Found it - now remove it from the list of entries: */
  1328. desc->action = NULL;
  1329. raw_spin_unlock_irqrestore(&desc->lock, flags);
  1330. unregister_handler_proc(irq, action);
  1331. module_put(desc->owner);
  1332. return action;
  1333. bad:
  1334. raw_spin_unlock_irqrestore(&desc->lock, flags);
  1335. return NULL;
  1336. }
  1337. /**
  1338. * remove_percpu_irq - free a per-cpu interrupt
  1339. * @irq: Interrupt line to free
  1340. * @act: irqaction for the interrupt
  1341. *
  1342. * Used to remove interrupts statically setup by the early boot process.
  1343. */
  1344. void remove_percpu_irq(unsigned int irq, struct irqaction *act)
  1345. {
  1346. struct irq_desc *desc = irq_to_desc(irq);
  1347. if (desc && irq_settings_is_per_cpu_devid(desc))
  1348. __free_percpu_irq(irq, act->percpu_dev_id);
  1349. }
  1350. /**
  1351. * free_percpu_irq - free an interrupt allocated with request_percpu_irq
  1352. * @irq: Interrupt line to free
  1353. * @dev_id: Device identity to free
  1354. *
  1355. * Remove a percpu interrupt handler. The handler is removed, but
  1356. * the interrupt line is not disabled. This must be done on each
  1357. * CPU before calling this function. The function does not return
  1358. * until any executing interrupts for this IRQ have completed.
  1359. *
  1360. * This function must not be called from interrupt context.
  1361. */
  1362. void free_percpu_irq(unsigned int irq, void __percpu *dev_id)
  1363. {
  1364. struct irq_desc *desc = irq_to_desc(irq);
  1365. if (!desc || !irq_settings_is_per_cpu_devid(desc))
  1366. return;
  1367. chip_bus_lock(desc);
  1368. kfree(__free_percpu_irq(irq, dev_id));
  1369. chip_bus_sync_unlock(desc);
  1370. }
  1371. /**
  1372. * setup_percpu_irq - setup a per-cpu interrupt
  1373. * @irq: Interrupt line to setup
  1374. * @act: irqaction for the interrupt
  1375. *
  1376. * Used to statically setup per-cpu interrupts in the early boot process.
  1377. */
  1378. int setup_percpu_irq(unsigned int irq, struct irqaction *act)
  1379. {
  1380. struct irq_desc *desc = irq_to_desc(irq);
  1381. int retval;
  1382. if (!desc || !irq_settings_is_per_cpu_devid(desc))
  1383. return -EINVAL;
  1384. chip_bus_lock(desc);
  1385. retval = __setup_irq(irq, desc, act);
  1386. chip_bus_sync_unlock(desc);
  1387. return retval;
  1388. }
  1389. /**
  1390. * request_percpu_irq - allocate a percpu interrupt line
  1391. * @irq: Interrupt line to allocate
  1392. * @handler: Function to be called when the IRQ occurs.
  1393. * @devname: An ascii name for the claiming device
  1394. * @dev_id: A percpu cookie passed back to the handler function
  1395. *
  1396. * This call allocates interrupt resources, but doesn't
  1397. * automatically enable the interrupt. It has to be done on each
  1398. * CPU using enable_percpu_irq().
  1399. *
  1400. * Dev_id must be globally unique. It is a per-cpu variable, and
  1401. * the handler gets called with the interrupted CPU's instance of
  1402. * that variable.
  1403. */
  1404. int request_percpu_irq(unsigned int irq, irq_handler_t handler,
  1405. const char *devname, void __percpu *dev_id)
  1406. {
  1407. struct irqaction *action;
  1408. struct irq_desc *desc;
  1409. int retval;
  1410. if (!dev_id)
  1411. return -EINVAL;
  1412. desc = irq_to_desc(irq);
  1413. if (!desc || !irq_settings_can_request(desc) ||
  1414. !irq_settings_is_per_cpu_devid(desc))
  1415. return -EINVAL;
  1416. action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
  1417. if (!action)
  1418. return -ENOMEM;
  1419. action->handler = handler;
  1420. action->flags = IRQF_PERCPU | IRQF_NO_SUSPEND;
  1421. action->name = devname;
  1422. action->percpu_dev_id = dev_id;
  1423. chip_bus_lock(desc);
  1424. retval = __setup_irq(irq, desc, action);
  1425. chip_bus_sync_unlock(desc);
  1426. if (retval)
  1427. kfree(action);
  1428. return retval;
  1429. }