开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > Linux/Unix编程 > 查看源码
irq.c
资源名称：linux-2.4.20.tar.gz　[点击查看]
上传用户：jlfgdled
上传日期：2013-04-10
资源大小：33168k
文件大小：24k
源码类别：

Linux/Unix编程

开发平台：

Unix_Linux

irq.c：源码内容
  1. /*
  2.  * BK Id: %F% %I% %G% %U% %#%
  3.  */
  4. /*
  5.  *  arch/ppc/kernel/irq.c
  6.  *
  7.  *  Derived from arch/i386/kernel/irq.c
  8.  *    Copyright (C) 1992 Linus Torvalds
  9.  *  Adapted from arch/i386 by Gary Thomas
  10.  *    Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org)
  11.  *  Updated and modified by Cort Dougan <cort@fsmlabs.com>
  12.  *    Copyright (C) 1996-2001 Cort Dougan
  13.  *  Adapted for Power Macintosh by Paul Mackerras
  14.  *    Copyright (C) 1996 Paul Mackerras (paulus@cs.anu.edu.au)
  15.  *  Amiga/APUS changes by Jesper Skov (jskov@cygnus.co.uk).
  16.  *  
  17.  * This file contains the code used by various IRQ handling routines:
  18.  * asking for different IRQ's should be done through these routines
  19.  * instead of just grabbing them. Thus setups with different IRQ numbers
  20.  * shouldn't result in any weird surprises, and installing new handlers
  21.  * should be easier.
  22.  *
  23.  * The MPC8xx has an interrupt mask in the SIU.  If a bit is set, the
  24.  * interrupt is _enabled_.  As expected, IRQ0 is bit 0 in the 32-bit
  25.  * mask register (of which only 16 are defined), hence the weird shifting
  26.  * and compliment of the cached_irq_mask.  I want to be able to stuff
  27.  * this right into the SIU SMASK register.
  28.  * Many of the prep/chrp functions are conditional compiled on CONFIG_8xx
  29.  * to reduce code space and undefined function references.
  30.  */
  33. #include <linux/ptrace.h>
  34. #include <linux/errno.h>
  35. #include <linux/threads.h>
  36. #include <linux/kernel_stat.h>
  37. #include <linux/signal.h>
  38. #include <linux/sched.h>
  39. #include <linux/ioport.h>
  40. #include <linux/interrupt.h>
  41. #include <linux/timex.h>
  42. #include <linux/config.h>
  43. #include <linux/init.h>
  44. #include <linux/slab.h>
  45. #include <linux/pci.h>
  46. #include <linux/delay.h>
  47. #include <linux/irq.h>
  48. #include <linux/proc_fs.h>
  49. #include <linux/random.h>
  51. #include <asm/uaccess.h>
  52. #include <asm/bitops.h>
  53. #include <asm/system.h>
  54. #include <asm/io.h>
  55. #include <asm/pgtable.h>
  56. #include <asm/irq.h>
  57. #include <asm/cache.h>
  58. #include <asm/prom.h>
  59. #include <asm/ptrace.h>
  61. #define NR_MASK_WORDS ((NR_IRQS + 31) / 32)
  63. extern atomic_t ipi_recv;
  64. extern atomic_t ipi_sent;
  65. void enable_irq(unsigned int irq_nr);
  66. void disable_irq(unsigned int irq_nr);
  68. static void register_irq_proc (unsigned int irq);
  70. #define MAXCOUNT 10000000
  72. irq_desc_t irq_desc[NR_IRQS] __cacheline_aligned =
  73. { [0 ... NR_IRQS-1] = { 0, NULL, NULL, 0, SPIN_LOCK_UNLOCKED}};
  75. int ppc_spurious_interrupts = 0;
  76. struct irqaction *ppc_irq_action[NR_IRQS];
  77. unsigned long ppc_cached_irq_mask[NR_MASK_WORDS];
  78. unsigned long ppc_lost_interrupts[NR_MASK_WORDS];
  79. atomic_t ppc_n_lost_interrupts;
  81. /* nasty hack for shared irq's since we need to do kmalloc calls but
  82.  * can't very early in the boot when we need to do a request irq.
  83.  * this needs to be removed.
  84.  * -- Cort
  85.  */
  86. #define IRQ_KMALLOC_ENTRIES 8
  87. static int cache_bitmask = 0;
  88. static struct irqaction malloc_cache[IRQ_KMALLOC_ENTRIES];
  89. extern int mem_init_done;
  91. #if defined(CONFIG_TAU_INT)
  92. extern int tau_interrupts(unsigned long cpu);
  93. extern int tau_initialized;
  94. #endif
  96. void *irq_kmalloc(size_t size, int pri)
  97. {
  98. unsigned int i;
  99. if ( mem_init_done )
  100. return kmalloc(size,pri);
  101. for ( i = 0; i < IRQ_KMALLOC_ENTRIES ; i++ )
  102. if ( ! ( cache_bitmask & (1<<i) ) )
  103. {
  104. cache_bitmask |= (1<<i);
  105. return (void *)(&malloc_cache[i]);
  106. }
  107. return 0;
  108. }
  110. void irq_kfree(void *ptr)
  111. {
  112. unsigned int i;
  113. for ( i = 0 ; i < IRQ_KMALLOC_ENTRIES ; i++ )
  114. if ( ptr == &malloc_cache[i] )
  115. {
  116. cache_bitmask &= ~(1<<i);
  117. return;
  118. }
  119. kfree(ptr);
  120. }
  122. int
  123. setup_irq(unsigned int irq, struct irqaction * new)
  124. {
  125. int shared = 0;
  126. unsigned long flags;
  127. struct irqaction *old, **p;
  128. irq_desc_t *desc = irq_desc + irq;
  130. /*
  131.  * Some drivers like serial.c use request_irq() heavily,
  132.  * so we have to be careful not to interfere with a
  133.  * running system.
  134.  */
  135. if (new->flags & SA_SAMPLE_RANDOM) {
  136. /*
  137.  * This function might sleep, we want to call it first,
  138.  * outside of the atomic block.
  139.  * Yes, this might clear the entropy pool if the wrong
  140.  * driver is attempted to be loaded, without actually
  141.  * installing a new handler, but is this really a problem,
  142.  * only the sysadmin is able to do this.
  143.  */
  144. rand_initialize_irq(irq);
  145. }
  147. /*
  148.  * The following block of code has to be executed atomically
  149.  */
  150. spin_lock_irqsave(&desc->lock,flags);
  151. p = &desc->action;
  152. if ((old = *p) != NULL) {
  153. /* Can't share interrupts unless both agree to */
  154. if (!(old->flags & new->flags & SA_SHIRQ)) {
  155. spin_unlock_irqrestore(&desc->lock,flags);
  156. return -EBUSY;
  157. }
  159. /* add new interrupt at end of irq queue */
  160. do {
  161. p = &old->next;
  162. old = *p;
  163. } while (old);
  164. shared = 1;
  165. }
  167. *p = new;
  169. if (!shared) {
  170. desc->depth = 0;
  171. desc->status &= ~(IRQ_DISABLED | IRQ_AUTODETECT | IRQ_WAITING);
  172. unmask_irq(irq);
  173. }
  174. spin_unlock_irqrestore(&desc->lock,flags);
  176. register_irq_proc(irq);
  177. return 0;
  178. }
  180. #if (defined(CONFIG_8xx) || defined(CONFIG_8260))
  181. /* Name change so we can catch standard drivers that potentially mess up
  182.  * the internal interrupt controller on 8xx and 8260.  Just bear with me,
  183.  * I don't like this either and I am searching a better solution.  For
  184.  * now, this is what I need. -- Dan
  185.  */
  186. #define request_irq request_8xxirq
  187. #endif
  189. void free_irq(unsigned int irq, void* dev_id)
  190. {
  191. irq_desc_t *desc;
  192. struct irqaction **p;
  193. unsigned long flags;
  195. desc = irq_desc + irq;
  196. spin_lock_irqsave(&desc->lock,flags);
  197. p = &desc->action;
  198. for (;;) {
  199. struct irqaction * action = *p;
  200. if (action) {
  201. struct irqaction **pp = p;
  202. p = &action->next;
  203. if (action->dev_id != dev_id)
  204. continue;
  206. /* Found it - now remove it from the list of entries */
  207. *pp = action->next;
  208. if (!desc->action) {
  209. desc->status |= IRQ_DISABLED;
  210. mask_irq(irq);
  211. }
  212. spin_unlock_irqrestore(&desc->lock,flags);
  214. #ifdef CONFIG_SMP
  215. /* Wait to make sure it's not being used on another CPU */
  216. while (desc->status & IRQ_INPROGRESS)
  217. barrier();
  218. #endif
  219. irq_kfree(action);
  220. return;
  221. }
  222. printk("Trying to free free IRQ%dn",irq);
  223. spin_unlock_irqrestore(&desc->lock,flags);
  224. break;
  225. }
  226. return;
  227. }
  229. int request_irq(unsigned int irq, void (*handler)(int, void *, struct pt_regs *),
  230. unsigned long irqflags, const char * devname, void *dev_id)
  231. {
  232. struct irqaction *action;
  233. int retval;
  235. if (irq >= NR_IRQS)
  236. return -EINVAL;
  237. if (!handler)
  238. {
  239. /*
  240.  * free_irq() used to be implemented as a call to
  241.  * request_irq() with handler being NULL.  Now we have
  242.  * a real free_irq() but need to allow the old behavior
  243.  * for old code that hasn't caught up yet.
  244.  *  -- Cort <cort@fsmlabs.com>
  245.  */
  246. free_irq(irq, dev_id);
  247. return 0;
  248. }
  250. action = (struct irqaction *)
  251. irq_kmalloc(sizeof(struct irqaction), GFP_KERNEL);
  252. if (!action) {
  253. printk(KERN_ERR "irq_kmalloc() failed for irq %d !n", irq);
  254. return -ENOMEM;
  255. }
  257. action->handler = handler;
  258. action->flags = irqflags;
  259. action->mask = 0;
  260. action->name = devname;
  261. action->dev_id = dev_id;
  262. action->next = NULL;
  264. retval = setup_irq(irq, action);
  265. if (retval)
  266. {
  267. kfree(action);
  268. return retval;
  269. }
  271. return 0;
  272. }
  274. /*
  275.  * Generic enable/disable code: this just calls
  276.  * down into the PIC-specific version for the actual
  277.  * hardware disable after having gotten the irq
  278.  * controller lock. 
  279.  */
  280.  
  281. /**
  282.  * disable_irq_nosync - disable an irq without waiting
  283.  * @irq: Interrupt to disable
  284.  *
  285.  * Disable the selected interrupt line. Disables of an interrupt
  286.  * stack. Unlike disable_irq(), this function does not ensure existing
  287.  * instances of the IRQ handler have completed before returning.
  288.  *
  289.  * This function may be called from IRQ context.
  290.  */
  291.  
  292.  void disable_irq_nosync(unsigned int irq)
  293. {
  294. irq_desc_t *desc = irq_desc + irq;
  295. unsigned long flags;
  297. spin_lock_irqsave(&desc->lock, flags);
  298. if (!desc->depth++) {
  299. if (!(desc->status & IRQ_PER_CPU))
  300. desc->status |= IRQ_DISABLED;
  301. mask_irq(irq);
  302. }
  303. spin_unlock_irqrestore(&desc->lock, flags);
  304. }
  306. /**
  307.  * disable_irq - disable an irq and wait for completion
  308.  * @irq: Interrupt to disable
  309.  *
  310.  * Disable the selected interrupt line. Disables of an interrupt
  311.  * stack. That is for two disables you need two enables. This
  312.  * function waits for any pending IRQ handlers for this interrupt
  313.  * to complete before returning. If you use this function while
  314.  * holding a resource the IRQ handler may need you will deadlock.
  315.  *
  316.  * This function may be called - with care - from IRQ context.
  317.  */
  318.  
  319. void disable_irq(unsigned int irq)
  320. {
  321. disable_irq_nosync(irq);
  323. if (!local_irq_count(smp_processor_id())) {
  324. do {
  325. barrier();
  326. } while (irq_desc[irq].status & IRQ_INPROGRESS);
  327. }
  328. }
  330. /**
  331.  * enable_irq - enable interrupt handling on an irq
  332.  * @irq: Interrupt to enable
  333.  *
  334.  * Re-enables the processing of interrupts on this IRQ line
  335.  * providing no disable_irq calls are now in effect.
  336.  *
  337.  * This function may be called from IRQ context.
  338.  */
  339.  
  340. void enable_irq(unsigned int irq)
  341. {
  342. irq_desc_t *desc = irq_desc + irq;
  343. unsigned long flags;
  345. spin_lock_irqsave(&desc->lock, flags);
  346. switch (desc->depth) {
  347. case 1: {
  348. unsigned int status = desc->status & ~IRQ_DISABLED;
  349. desc->status = status;
  350. if ((status & (IRQ_PENDING | IRQ_REPLAY)) == IRQ_PENDING) {
  351. desc->status = status | IRQ_REPLAY;
  352. hw_resend_irq(desc->handler,irq);
  353. }
  354. unmask_irq(irq);
  355. /* fall-through */
  356. }
  357. default:
  358. desc->depth--;
  359. break;
  360. case 0:
  361. printk("enable_irq(%u) unbalancedn", irq);
  362. }
  363. spin_unlock_irqrestore(&desc->lock, flags);
  364. }
  366. int get_irq_list(char *buf)
  367. {
  368. int i, len = 0, j;
  369. struct irqaction * action;
  371. len += sprintf(buf+len, "           ");
  372. for (j=0; j<smp_num_cpus; j++)
  373. len += sprintf(buf+len, "CPU%d       ",j);
  374. *(char *)(buf+len++) = 'n';
  376. for (i = 0 ; i < NR_IRQS ; i++) {
  377. action = irq_desc[i].action;
  378. if ( !action || !action->handler )
  379. continue;
  380. len += sprintf(buf+len, "%3d: ", i);
  381. #ifdef CONFIG_SMP
  382. for (j = 0; j < smp_num_cpus; j++)
  383. len += sprintf(buf+len, "%10u ",
  384. kstat.irqs[cpu_logical_map(j)][i]);
  385. #else
  386. len += sprintf(buf+len, "%10u ", kstat_irqs(i));
  387. #endif /* CONFIG_SMP */
  388. if ( irq_desc[i].handler )
  389. len += sprintf(buf+len, " %s ", irq_desc[i].handler->typename );
  390. else
  391. len += sprintf(buf+len, "  None      ");
  392. len += sprintf(buf+len, "%s", (irq_desc[i].status & IRQ_LEVEL) ? "Level " : "Edge  ");
  393. len += sprintf(buf+len, "    %s",action->name);
  394. for (action=action->next; action; action = action->next) {
  395. len += sprintf(buf+len, ", %s", action->name);
  396. }
  397. len += sprintf(buf+len, "n");
  398. }
  399. #ifdef CONFIG_TAU_INT
  400. if (tau_initialized){
  401. len += sprintf(buf+len, "TAU: ");
  402. for (j = 0; j < smp_num_cpus; j++)
  403. len += sprintf(buf+len, "%10u ",
  404. tau_interrupts(j));
  405. len += sprintf(buf+len, "  PowerPC             Thermal Assist (cpu temp)n");
  406. }
  407. #endif
  408. #ifdef CONFIG_SMP
  409. /* should this be per processor send/receive? */
  410. len += sprintf(buf+len, "IPI (recv/sent): %10u/%un",
  411.        atomic_read(&ipi_recv), atomic_read(&ipi_sent));
  412. #endif
  413. len += sprintf(buf+len, "BAD: %10un", ppc_spurious_interrupts);
  414. return len;
  415. }
  417. static inline void
  418. handle_irq_event(int irq, struct pt_regs *regs, struct irqaction *action)
  419. {
  420. int status = 0;
  422. if (!(action->flags & SA_INTERRUPT))
  423. __sti();
  425. do {
  426. status |= action->flags;
  427. action->handler(irq, action->dev_id, regs);
  428. action = action->next;
  429. } while (action);
  430. if (status & SA_SAMPLE_RANDOM)
  431. add_interrupt_randomness(irq);
  432. __cli();
  433. }
  435. /*
  436.  * Eventually, this should take an array of interrupts and an array size
  437.  * so it can dispatch multiple interrupts.
  438.  */
  439. void ppc_irq_dispatch_handler(struct pt_regs *regs, int irq)
  440. {
  441. int status;
  442. struct irqaction *action;
  443. int cpu = smp_processor_id();
  444. irq_desc_t *desc = irq_desc + irq;
  446. kstat.irqs[cpu][irq]++;
  447. spin_lock(&desc->lock);
  448. ack_irq(irq);
  449. /*
  450.    REPLAY is when Linux resends an IRQ that was dropped earlier
  451.    WAITING is used by probe to mark irqs that are being tested
  452.    */
  453. status = desc->status & ~(IRQ_REPLAY | IRQ_WAITING);
  454. if (!(status & IRQ_PER_CPU))
  455. status |= IRQ_PENDING; /* we _want_ to handle it */
  457. /*
  458.  * If the IRQ is disabled for whatever reason, we cannot
  459.  * use the action we have.
  460.  */
  461. action = NULL;
  462. if (!(status & (IRQ_DISABLED | IRQ_INPROGRESS))) {
  463. action = desc->action;
  464. if (!action || !action->handler) {
  465. ppc_spurious_interrupts++;
  466. printk(KERN_DEBUG "Unhandled interrupt %x, disabledn", irq);
  467. /* We can't call disable_irq here, it would deadlock */
  468. ++desc->depth;
  469. desc->status |= IRQ_DISABLED;
  470. mask_irq(irq);
  471. /* This is a real interrupt, we have to eoi it,
  472.    so we jump to out */
  473. goto out;
  474. }
  475. status &= ~IRQ_PENDING; /* we commit to handling */
  476. if (!(status & IRQ_PER_CPU))
  477. status |= IRQ_INPROGRESS; /* we are handling it */
  478. }
  479. desc->status = status;
  481. /*
  482.  * If there is no IRQ handler or it was disabled, exit early.
  483.    Since we set PENDING, if another processor is handling
  484.    a different instance of this same irq, the other processor
  485.    will take care of it.
  486.  */
  487. if (!action)
  488. goto out;
  491. /*
  492.  * Edge triggered interrupts need to remember
  493.  * pending events.
  494.  * This applies to any hw interrupts that allow a second
  495.  * instance of the same irq to arrive while we are in do_IRQ
  496.  * or in the handler. But the code here only handles the _second_
  497.  * instance of the irq, not the third or fourth. So it is mostly
  498.  * useful for irq hardware that does not mask cleanly in an
  499.  * SMP environment.
  500.  */
  501. for (;;) {
  502. spin_unlock(&desc->lock);
  503. handle_irq_event(irq, regs, action);
  504. spin_lock(&desc->lock);
  506. if (!(desc->status & IRQ_PENDING))
  507. break;
  508. desc->status &= ~IRQ_PENDING;
  509. }
  510. desc->status &= ~IRQ_INPROGRESS;
  511. out:
  512. /*
  513.  * The ->end() handler has to deal with interrupts which got
  514.  * disabled while the handler was running.
  515.  */
  516. if (irq_desc[irq].handler) {
  517. if (irq_desc[irq].handler->end)
  518. irq_desc[irq].handler->end(irq);
  519. else if (irq_desc[irq].handler->enable)
  520. irq_desc[irq].handler->enable(irq);
  521. }
  522. spin_unlock(&desc->lock);
  523. }
  525. int do_IRQ(struct pt_regs *regs)
  526. {
  527. int cpu = smp_processor_id();
  528. int irq, first = 1;
  529.         hardirq_enter( cpu );
  531. for (;;) {
  532. /*
  533.  * Every arch is required to implement ppc_md.get_irq.
  534.  * This function will either return an irq number or -1 to
  535.  * indicate there are no more pending.  But the first time
  536.  * through the loop this means there wasn't and IRQ pending.
  537.  * The value -2 is for buggy hardware and means that this IRQ
  538.  * has already been handled. -- Tom
  539.  */
  540. irq = ppc_md.get_irq( regs );
  542. if (irq >= 0)
  543. ppc_irq_dispatch_handler( regs, irq );
  544. else {
  545. if (irq != -2 && first)
  546. /* That's not SMP safe ... but who cares ? */
  547. ppc_spurious_interrupts++;
  548. break;
  549. }
  550. first = 0;
  551. }
  552.         hardirq_exit( cpu );
  554. if (softirq_pending(cpu))
  555. do_softirq();
  556. return 1; /* lets ret_from_int know we can do checks */
  557. }
  559. unsigned long probe_irq_on (void)
  560. {
  561. return 0;
  562. }
  564. int probe_irq_off (unsigned long irqs)
  565. {
  566. return 0;
  567. }
  569. unsigned int probe_irq_mask(unsigned long irqs)
  570. {
  571. return 0;
  572. }
  574. void __init init_IRQ(void)
  575. {
  576. static int once = 0;
  578. if ( once )
  579. return;
  580. else
  581. once++;
  583. ppc_md.init_IRQ();
  584. }
  586. #ifdef CONFIG_SMP
  587. unsigned char global_irq_holder = NO_PROC_ID;
  588. unsigned volatile long global_irq_lock; /* pendantic :long for set_bit--RR*/
  589. atomic_t global_irq_count;
  591. atomic_t global_bh_count;
  593. static void show(char * str)
  594. {
  595. int i;
  596. unsigned long *stack;
  597. int cpu = smp_processor_id();
  599. printk("n%s, CPU %d:n", str, cpu);
  600. printk("irq:  %d [%d %d]n",
  601.        atomic_read(&global_irq_count),
  602.        local_irq_count(0),
  603.        local_irq_count(1));
  604. printk("bh:   %d [%d %d]n",
  605.        atomic_read(&global_bh_count),
  606.        local_bh_count(0),
  607.        local_bh_count(1));
  608. stack = (unsigned long *) &str;
  609. for (i = 40; i ; i--) {
  610. unsigned long x = *++stack;
  611. if (x > (unsigned long) &init_task_union && x < (unsigned long) &vsprintf) {
  612. printk("<[%08lx]> ", x);
  613. }
  614. }
  615. }
  617. static inline void wait_on_bh(void)
  618. {
  619. int count = MAXCOUNT;
  620. do {
  621. if (!--count) {
  622. show("wait_on_bh");
  623. count = ~0;
  624. }
  625. /* nothing .. wait for the other bh's to go away */
  626. } while (atomic_read(&global_bh_count) != 0);
  627. }
  630. static inline void wait_on_irq(int cpu)
  631. {
  632. int count = MAXCOUNT;
  634. for (;;) {
  636. /*
  637.  * Wait until all interrupts are gone. Wait
  638.  * for bottom half handlers unless we're
  639.  * already executing in one..
  640.  */
  641. if (!atomic_read(&global_irq_count)) {
  642. if (local_bh_count(cpu)
  643.     || !atomic_read(&global_bh_count))
  644. break;
  645. }
  647. /* Duh, we have to loop. Release the lock to avoid deadlocks */
  648. clear_bit(0,&global_irq_lock);
  650. for (;;) {
  651. if (!--count) {
  652. show("wait_on_irq");
  653. count = ~0;
  654. }
  655. __sti();
  656. /* don't worry about the lock race Linus found
  657.  * on intel here. -- Cort
  658.  */
  659. __cli();
  660. if (atomic_read(&global_irq_count))
  661. continue;
  662. if (global_irq_lock)
  663. continue;
  664. if (!local_bh_count(cpu)
  665.     && atomic_read(&global_bh_count))
  666. continue;
  667. if (!test_and_set_bit(0,&global_irq_lock))
  668. break;
  669. }
  670. }
  671. }
  673. /*
  674.  * This is called when we want to synchronize with
  675.  * bottom half handlers. We need to wait until
  676.  * no other CPU is executing any bottom half handler.
  677.  *
  678.  * Don't wait if we're already running in an interrupt
  679.  * context or are inside a bh handler.
  680.  */
  681. void synchronize_bh(void)
  682. {
  683. if (atomic_read(&global_bh_count) && !in_interrupt())
  684. wait_on_bh();
  685. }
  687. /*
  688.  * This is called when we want to synchronize with
  689.  * interrupts. We may for example tell a device to
  690.  * stop sending interrupts: but to make sure there
  691.  * are no interrupts that are executing on another
  692.  * CPU we need to call this function.
  693.  */
  694. void synchronize_irq(void)
  695. {
  696. if (atomic_read(&global_irq_count)) {
  697. /* Stupid approach */
  698. cli();
  699. sti();
  700. }
  701. }
  703. static inline void get_irqlock(int cpu)
  704. {
  705. unsigned int loops = MAXCOUNT;
  707. if (test_and_set_bit(0,&global_irq_lock)) {
  708. /* do we already hold the lock? */
  709. if ((unsigned char) cpu == global_irq_holder)
  710. return;
  711. /* Uhhuh.. Somebody else got it. Wait.. */
  712. do {
  713. do {
  714. if (loops-- == 0) {
  715. printk("get_irqlock(%d) waiting, global_irq_holder=%dn", cpu, global_irq_holder);
  716. #ifdef CONFIG_XMON
  717. xmon(0);
  718. #endif
  719. }
  720. } while (test_bit(0,&global_irq_lock));
  721. } while (test_and_set_bit(0,&global_irq_lock));
  722. }
  723. /* 
  724.  * We also need to make sure that nobody else is running
  725.  * in an interrupt context. 
  726.  */
  727. wait_on_irq(cpu);
  729. /*
  730.  * Ok, finally..
  731.  */
  732. global_irq_holder = cpu;
  733. }
  735. /*
  736.  * A global "cli()" while in an interrupt context
  737.  * turns into just a local cli(). Interrupts
  738.  * should use spinlocks for the (very unlikely)
  739.  * case that they ever want to protect against
  740.  * each other.
  741.  *
  742.  * If we already have local interrupts disabled,
  743.  * this will not turn a local disable into a
  744.  * global one (problems with spinlocks: this makes
  745.  * save_flags+cli+sti usable inside a spinlock).
  746.  */
  747. void __global_cli(void)
  748. {
  749. unsigned long flags;
  751. __save_flags(flags);
  752. if (flags & (1 << 15)) {
  753. int cpu = smp_processor_id();
  754. __cli();
  755. if (!local_irq_count(cpu))
  756. get_irqlock(cpu);
  757. }
  758. }
  760. void __global_sti(void)
  761. {
  762. int cpu = smp_processor_id();
  764. if (!local_irq_count(cpu))
  765. release_irqlock(cpu);
  766. __sti();
  767. }
  769. /*
  770.  * SMP flags value to restore to:
  771.  * 0 - global cli
  772.  * 1 - global sti
  773.  * 2 - local cli
  774.  * 3 - local sti
  775.  */
  776. unsigned long __global_save_flags(void)
  777. {
  778. int retval;
  779. int local_enabled;
  780. unsigned long flags;
  782. __save_flags(flags);
  783. local_enabled = (flags >> 15) & 1;
  784. /* default to local */
  785. retval = 2 + local_enabled;
  787. /* check for global flags if we're not in an interrupt */
  788. if (!local_irq_count(smp_processor_id())) {
  789. if (local_enabled)
  790. retval = 1;
  791. if (global_irq_holder == (unsigned char) smp_processor_id())
  792. retval = 0;
  793. }
  794. return retval;
  795. }
  797. int
  798. tb(long vals[],
  799.    int  max_size)
  800. {
  801.    register unsigned long *orig_sp __asm__ ("r1");
  802.    register unsigned long lr __asm__ ("r3");
  803.    unsigned long *sp;
  804.    int i;
  806.    asm volatile ("mflr 3");
  807.    vals[0] = lr;
  808.    sp = (unsigned long *) *orig_sp;
  809.    sp = (unsigned long *) *sp;
  810.    for (i=1; i<max_size; i++) {
  811.       if (sp == 0) {
  812.          break;
  813.       }
  815.       vals[i] = *(sp+1);
  816.       sp = (unsigned long *) *sp;
  817.    }
  819.    return i;
  820. }
  822. void __global_restore_flags(unsigned long flags)
  823. {
  824. switch (flags) {
  825. case 0:
  826. __global_cli();
  827. break;
  828. case 1:
  829. __global_sti();
  830. break;
  831. case 2:
  832. __cli();
  833. break;
  834. case 3:
  835. __sti();
  836. break;
  837. default:
  838. {
  839. unsigned long trace[5];
  840.                 int           count;
  841.                 int           i;
  843. printk("global_restore_flags: %08lx (%08lx)n",
  844. flags, (&flags)[-1]);
  845.                 count = tb(trace, 5);
  846.                 printk("tb:");
  847.                 for(i=0; i<count; i++) {
  848. printk(" %8.8lx", trace[i]);
  849. }
  850. printk("n");
  851. }
  852. }
  853. }
  854. #endif /* CONFIG_SMP */
  856. static struct proc_dir_entry *root_irq_dir;
  857. static struct proc_dir_entry *irq_dir[NR_IRQS];
  858. static struct proc_dir_entry *smp_affinity_entry[NR_IRQS];
  860. #ifdef CONFIG_IRQ_ALL_CPUS
  861. #define DEFAULT_CPU_AFFINITY 0xffffffff
  862. #else
  863. #define DEFAULT_CPU_AFFINITY 0x00000001
  864. #endif
  866. unsigned int irq_affinity [NR_IRQS] =
  867. { [0 ... NR_IRQS-1] = DEFAULT_CPU_AFFINITY };
  869. #define HEX_DIGITS 8
  871. static int irq_affinity_read_proc (char *page, char **start, off_t off,
  872. int count, int *eof, void *data)
  873. {
  874. if (count < HEX_DIGITS+1)
  875. return -EINVAL;
  876. return sprintf (page, "%08xn", irq_affinity[(int)data]);
  877. }
  879. static unsigned int parse_hex_value (const char *buffer,
  880. unsigned long count, unsigned long *ret)
  881. {
  882. unsigned char hexnum [HEX_DIGITS];
  883. unsigned long value;
  884. int i;
  886. if (!count)
  887. return -EINVAL;
  888. if (count > HEX_DIGITS)
  889. count = HEX_DIGITS;
  890. if (copy_from_user(hexnum, buffer, count))
  891. return -EFAULT;
  893. /*
  894.  * Parse the first 8 characters as a hex string, any non-hex char
  895.  * is end-of-string. '00e1', 'e1', '00E1', 'E1' are all the same.
  896.  */
  897. value = 0;
  899. for (i = 0; i < count; i++) {
  900. unsigned int c = hexnum[i];
  902. switch (c) {
  903. case '0' ... '9': c -= '0'; break;
  904. case 'a' ... 'f': c -= 'a'-10; break;
  905. case 'A' ... 'F': c -= 'A'-10; break;
  906. default:
  907. goto out;
  908. }
  909. value = (value << 4) | c;
  910. }
  911. out:
  912. *ret = value;
  913. return 0;
  914. }
  916. static int irq_affinity_write_proc (struct file *file, const char *buffer,
  917. unsigned long count, void *data)
  918. {
  919. int irq = (int) data, full_count = count, err;
  920. unsigned long new_value;
  922. if (!irq_desc[irq].handler->set_affinity)
  923. return -EIO;
  925. err = parse_hex_value(buffer, count, &new_value);
  927. /*
  928.  * Do not allow disabling IRQs completely - it's a too easy
  929.  * way to make the system unusable accidentally :-) At least
  930.  * one online CPU still has to be targeted.
  931.  *
  932.  * We assume a 1-1 logical<->physical cpu mapping here.  If
  933.  * we assume that the cpu indices in /proc/irq/../smp_affinity
  934.  * are actually logical cpu #'s then we have no problem.
  935.  *  -- Cort <cort@fsmlabs.com>
  936.  */
  937. if (!(new_value & cpu_online_map))
  938. return -EINVAL;
  940. irq_affinity[irq] = new_value;
  941. irq_desc[irq].handler->set_affinity(irq, new_value);
  943. return full_count;
  944. }
  946. static int prof_cpu_mask_read_proc (char *page, char **start, off_t off,
  947. int count, int *eof, void *data)
  948. {
  949. unsigned long *mask = (unsigned long *) data;
  950. if (count < HEX_DIGITS+1)
  951. return -EINVAL;
  952. return sprintf (page, "%08lxn", *mask);
  953. }
  955. static int prof_cpu_mask_write_proc (struct file *file, const char *buffer,
  956. unsigned long count, void *data)
  957. {
  958. unsigned long *mask = (unsigned long *) data, full_count = count, err;
  959. unsigned long new_value;
  961. err = parse_hex_value(buffer, count, &new_value);
  962. if (err)
  963. return err;
  965. *mask = new_value;
  966. return full_count;
  967. }
  969. #define MAX_NAMELEN 10
  971. static void register_irq_proc (unsigned int irq)
  972. {
  973. struct proc_dir_entry *entry;
  974. char name [MAX_NAMELEN];
  976. if (!root_irq_dir || (irq_desc[irq].handler == NULL) || irq_dir[irq])
  977. return;
  979. memset(name, 0, MAX_NAMELEN);
  980. sprintf(name, "%d", irq);
  982. /* create /proc/irq/1234 */
  983. irq_dir[irq] = proc_mkdir(name, root_irq_dir);
  985. /* create /proc/irq/1234/smp_affinity */
  986. entry = create_proc_entry("smp_affinity", 0600, irq_dir[irq]);
  988. entry->nlink = 1;
  989. entry->data = (void *)irq;
  990. entry->read_proc = irq_affinity_read_proc;
  991. entry->write_proc = irq_affinity_write_proc;
  993. smp_affinity_entry[irq] = entry;
  994. }
  996. unsigned long prof_cpu_mask = -1;
  998. void init_irq_proc (void)
  999. {
  1000. struct proc_dir_entry *entry;
  1001. int i;
  1003. /* create /proc/irq */
  1004. root_irq_dir = proc_mkdir("irq", 0);
  1006. /* create /proc/irq/prof_cpu_mask */
  1007. entry = create_proc_entry("prof_cpu_mask", 0600, root_irq_dir);
  1009. entry->nlink = 1;
  1010. entry->data = (void *)&prof_cpu_mask;
  1011. entry->read_proc = prof_cpu_mask_read_proc;
  1012. entry->write_proc = prof_cpu_mask_write_proc;
  1014. /*
  1015.  * Create entries for all existing IRQs.
  1016.  */
  1017. for (i = 0; i < NR_IRQS; i++) {
  1018. if (irq_desc[i].handler == NULL)
  1019. continue;
  1020. register_irq_proc(i);
  1021. }
  1022. }
  1024. void no_action(int irq, void *dev, struct pt_regs *regs)
  1025. {
  1026. }