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

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
irq.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：35k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

irq.c：源码内容
  1. /* $Id: irq.c,v 1.112 2001/11/16 00:04:54 kanoj Exp $
  2.  * irq.c: UltraSparc IRQ handling/init/registry.
  3.  *
  4.  * Copyright (C) 1997  David S. Miller  (davem@caip.rutgers.edu)
  5.  * Copyright (C) 1998  Eddie C. Dost    (ecd@skynet.be)
  6.  * Copyright (C) 1998  Jakub Jelinek    (jj@ultra.linux.cz)
  7.  */
  9. #include <linux/config.h>
  10. #include <linux/ptrace.h>
  11. #include <linux/errno.h>
  12. #include <linux/kernel_stat.h>
  13. #include <linux/signal.h>
  14. #include <linux/mm.h>
  15. #include <linux/interrupt.h>
  16. #include <linux/slab.h>
  17. #include <linux/random.h>
  18. #include <linux/init.h>
  19. #include <linux/delay.h>
  20. #include <linux/proc_fs.h>
  21. #include <linux/kbd_ll.h>
  23. #include <asm/ptrace.h>
  24. #include <asm/processor.h>
  25. #include <asm/atomic.h>
  26. #include <asm/system.h>
  27. #include <asm/irq.h>
  28. #include <asm/sbus.h>
  29. #include <asm/iommu.h>
  30. #include <asm/upa.h>
  31. #include <asm/oplib.h>
  32. #include <asm/timer.h>
  33. #include <asm/smp.h>
  34. #include <asm/hardirq.h>
  35. #include <asm/softirq.h>
  36. #include <asm/starfire.h>
  37. #include <asm/uaccess.h>
  38. #include <asm/cache.h>
  40. #ifdef CONFIG_SMP
  41. static void distribute_irqs(void);
  42. #endif
  44. /* UPA nodes send interrupt packet to UltraSparc with first data reg
  45.  * value low 5 (7 on Starfire) bits holding the IRQ identifier being
  46.  * delivered.  We must translate this into a non-vector IRQ so we can
  47.  * set the softint on this cpu.
  48.  *
  49.  * To make processing these packets efficient and race free we use
  50.  * an array of irq buckets below.  The interrupt vector handler in
  51.  * entry.S feeds incoming packets into per-cpu pil-indexed lists.
  52.  * The IVEC handler does not need to act atomically, the PIL dispatch
  53.  * code uses CAS to get an atomic snapshot of the list and clear it
  54.  * at the same time.
  55.  */
  57. struct ino_bucket ivector_table[NUM_IVECS] __attribute__ ((aligned (SMP_CACHE_BYTES)));
  59. #ifndef CONFIG_SMP
  60. unsigned int __up_workvec[16] __attribute__ ((aligned (SMP_CACHE_BYTES)));
  61. #define irq_work(__cpu, __pil) &(__up_workvec[(void)(__cpu), (__pil)])
  62. #else
  63. #define irq_work(__cpu, __pil) &(cpu_data[(__cpu)].irq_worklists[(__pil)])
  64. #endif
  66. #ifdef CONFIG_PCI
  67. /* This is a table of physical addresses used to deal with IBF_DMA_SYNC.
  68.  * It is used for PCI only to synchronize DMA transfers with IRQ delivery
  69.  * for devices behind busses other than APB on Sabre systems.
  70.  *
  71.  * Currently these physical addresses are just config space accesses
  72.  * to the command register for that device.
  73.  */
  74. unsigned long pci_dma_wsync;
  75. unsigned long dma_sync_reg_table[256];
  76. unsigned char dma_sync_reg_table_entry = 0;
  77. #endif
  79. /* This is based upon code in the 32-bit Sparc kernel written mostly by
  80.  * David Redman (djhr@tadpole.co.uk).
  81.  */
  82. #define MAX_STATIC_ALLOC 4
  83. static struct irqaction static_irqaction[MAX_STATIC_ALLOC];
  84. static int static_irq_count = 0;
  86. /* This is exported so that fast IRQ handlers can get at it... -DaveM */
  87. struct irqaction *irq_action[NR_IRQS+1] = {
  88.   NULL, NULL, NULL, NULL, NULL, NULL , NULL, NULL,
  89.   NULL, NULL, NULL, NULL, NULL, NULL , NULL, NULL
  90. };
  92. static void register_irq_proc (unsigned int irq);
  94. /*
  95.  * Upper 2b of irqaction->flags holds the ino.
  96.  * irqaction->mask holds the smp affinity information.
  97.  */
  98. #define put_ino_in_irqaction(action, irq) 
  99. action->flags &= 0xffffffffffffUL; 
  100. if (__bucket(irq) == &pil0_dummy_bucket) 
  101. action->flags |= 0xdeadUL << 48;  
  102. else 
  103. action->flags |= __irq_ino(irq) << 48;
  104. #define get_ino_in_irqaction(action) (action->flags >> 48)
  106. #define put_smpaff_in_irqaction(action, smpaff) (action)->mask = (smpaff)
  107. #define get_smpaff_in_irqaction(action)  ((action)->mask)
  109. int get_irq_list(char *buf)
  110. {
  111. int i, len = 0;
  112. struct irqaction *action;
  113. #ifdef CONFIG_SMP
  114. int j;
  115. #endif
  117. for(i = 0; i < (NR_IRQS + 1); i++) {
  118. if(!(action = *(i + irq_action)))
  119. continue;
  120. len += sprintf(buf + len, "%3d: ", i);
  121. #ifndef CONFIG_SMP
  122. len += sprintf(buf + len, "%10u ", kstat_irqs(i));
  123. #else
  124. for (j = 0; j < smp_num_cpus; j++)
  125. len += sprintf(buf + len, "%10u ",
  126.        kstat.irqs[cpu_logical_map(j)][i]);
  127. #endif
  128. len += sprintf(buf + len, " %s:%lx", action->name, 
  129. get_ino_in_irqaction(action));
  130. for(action = action->next; action; action = action->next) {
  131. len += sprintf(buf+len, ", %s:%lx", action->name, 
  132. get_ino_in_irqaction(action));
  133. }
  134. len += sprintf(buf + len, "n");
  135. }
  136. return len;
  137. }
  139. /* Now these are always passed a true fully specified sun4u INO. */
  140. void enable_irq(unsigned int irq)
  141. {
  142. struct ino_bucket *bucket = __bucket(irq);
  143. unsigned long imap;
  144. unsigned long tid;
  146. imap = bucket->imap;
  147. if (imap == 0UL)
  148. return;
  150. if (tlb_type == cheetah) {
  151. /* We set it to our Safari AID. */
  152. __asm__ __volatile__("ldxa [%%g0] %1, %0"
  153.      : "=r" (tid)
  154.      : "i" (ASI_SAFARI_CONFIG));
  155. tid = ((tid & (0x3ffUL<<17)) << 9);
  156. tid &= IMAP_AID_SAFARI;
  157. } else if (this_is_starfire == 0) {
  158. /* We set it to our UPA MID. */
  159. __asm__ __volatile__("ldxa [%%g0] %1, %0"
  160.      : "=r" (tid)
  161.      : "i" (ASI_UPA_CONFIG));
  162. tid = ((tid & UPA_CONFIG_MID) << 9);
  163. tid &= IMAP_TID_UPA;
  164. } else {
  165. tid = (starfire_translate(imap, current->processor) << 26);
  166. tid &= IMAP_TID_UPA;
  167. }
  169. /* NOTE NOTE NOTE, IGN and INO are read-only, IGN is a product
  170.  * of this SYSIO's preconfigured IGN in the SYSIO Control
  171.  * Register, the hardware just mirrors that value here.
  172.  * However for Graphics and UPA Slave devices the full
  173.  * IMAP_INR field can be set by the programmer here.
  174.  *
  175.  * Things like FFB can now be handled via the new IRQ mechanism.
  176.  */
  177. upa_writel(tid | IMAP_VALID, imap);
  178. }
  180. /* This now gets passed true ino's as well. */
  181. void disable_irq(unsigned int irq)
  182. {
  183. struct ino_bucket *bucket = __bucket(irq);
  184. unsigned long imap;
  186. imap = bucket->imap;
  187. if (imap != 0UL) {
  188. u32 tmp;
  190. /* NOTE: We do not want to futz with the IRQ clear registers
  191.  *       and move the state to IDLE, the SCSI code does call
  192.  *       disable_irq() to assure atomicity in the queue cmd
  193.  *       SCSI adapter driver code.  Thus we'd lose interrupts.
  194.  */
  195. tmp = upa_readl(imap);
  196. tmp &= ~IMAP_VALID;
  197. upa_writel(tmp, imap);
  198. }
  199. }
  201. /* The timer is the one "weird" interrupt which is generated by
  202.  * the CPU %tick register and not by some normal vectored interrupt
  203.  * source.  To handle this special case, we use this dummy INO bucket.
  204.  */
  205. static struct ino_bucket pil0_dummy_bucket = {
  206. 0, /* irq_chain */
  207. 0, /* pil */
  208. 0, /* pending */
  209. 0, /* flags */
  210. 0, /* __unused */
  211. NULL, /* irq_info */
  212. 0UL, /* iclr */
  213. 0UL, /* imap */
  214. };
  216. unsigned int build_irq(int pil, int inofixup, unsigned long iclr, unsigned long imap)
  217. {
  218. struct ino_bucket *bucket;
  219. int ino;
  221. if(pil == 0) {
  222. if(iclr != 0UL || imap != 0UL) {
  223. prom_printf("Invalid dummy bucket for PIL0 (%lx:%lx)n",
  224.     iclr, imap);
  225. prom_halt();
  226. }
  227. return __irq(&pil0_dummy_bucket);
  228. }
  230. /* RULE: Both must be specified in all other cases. */
  231. if (iclr == 0UL || imap == 0UL) {
  232. prom_printf("Invalid build_irq %d %d %016lx %016lxn",
  233.     pil, inofixup, iclr, imap);
  234. prom_halt();
  235. }
  237. ino = (upa_readl(imap) & (IMAP_IGN | IMAP_INO)) + inofixup;
  238. if(ino > NUM_IVECS) {
  239. prom_printf("Invalid INO %04x (%d:%d:%016lx:%016lx)n",
  240.     ino, pil, inofixup, iclr, imap);
  241. prom_halt();
  242. }
  244. /* Ok, looks good, set it up.  Don't touch the irq_chain or
  245.  * the pending flag.
  246.  */
  247. bucket = &ivector_table[ino];
  248. if ((bucket->flags & IBF_ACTIVE) ||
  249.     (bucket->irq_info != NULL)) {
  250. /* This is a gross fatal error if it happens here. */
  251. prom_printf("IRQ: Trying to reinit INO bucket, fatal error.n");
  252. prom_printf("IRQ: Request INO %04x (%d:%d:%016lx:%016lx)n",
  253.     ino, pil, inofixup, iclr, imap);
  254. prom_printf("IRQ: Existing (%d:%016lx:%016lx)n",
  255.     bucket->pil, bucket->iclr, bucket->imap);
  256. prom_printf("IRQ: Cannot continue, halting...n");
  257. prom_halt();
  258. }
  259. bucket->imap  = imap;
  260. bucket->iclr  = iclr;
  261. bucket->pil   = pil;
  262. bucket->flags = 0;
  264. bucket->irq_info = NULL;
  266. return __irq(bucket);
  267. }
  269. static void atomic_bucket_insert(struct ino_bucket *bucket)
  270. {
  271. unsigned long pstate;
  272. unsigned int *ent;
  274. __asm__ __volatile__("rdpr %%pstate, %0" : "=r" (pstate));
  275. __asm__ __volatile__("wrpr %0, %1, %%pstate"
  276.      : : "r" (pstate), "i" (PSTATE_IE));
  277. ent = irq_work(smp_processor_id(), bucket->pil);
  278. bucket->irq_chain = *ent;
  279. *ent = __irq(bucket);
  280. __asm__ __volatile__("wrpr %0, 0x0, %%pstate" : : "r" (pstate));
  281. }
  283. int request_irq(unsigned int irq, void (*handler)(int, void *, struct pt_regs *),
  284. unsigned long irqflags, const char *name, void *dev_id)
  285. {
  286. struct irqaction *action, *tmp = NULL;
  287. struct ino_bucket *bucket = __bucket(irq);
  288. unsigned long flags;
  289. int pending = 0;
  291. if ((bucket != &pil0_dummy_bucket) &&
  292.     (bucket < &ivector_table[0] ||
  293.      bucket >= &ivector_table[NUM_IVECS])) {
  294. unsigned int *caller;
  296. __asm__ __volatile__("mov %%i7, %0" : "=r" (caller));
  297. printk(KERN_CRIT "request_irq: Old style IRQ registry attempt "
  298.        "from %p, irq %08x.n", caller, irq);
  299. return -EINVAL;
  300. }
  301. if(!handler)
  302.     return -EINVAL;
  304. if ((bucket != &pil0_dummy_bucket) && (irqflags & SA_SAMPLE_RANDOM)) {
  305. /*
  306.    * This function might sleep, we want to call it first,
  307.    * outside of the atomic block. In SA_STATIC_ALLOC case,
  308.  * random driver's kmalloc will fail, but it is safe.
  309.  * If already initialized, random driver will not reinit.
  310.    * Yes, this might clear the entropy pool if the wrong
  311.    * driver is attempted to be loaded, without actually
  312.    * installing a new handler, but is this really a problem,
  313.    * only the sysadmin is able to do this.
  314.    */
  315. rand_initialize_irq(irq);
  316. }
  318. save_and_cli(flags);
  320. action = *(bucket->pil + irq_action);
  321. if(action) {
  322. if((action->flags & SA_SHIRQ) && (irqflags & SA_SHIRQ))
  323. for (tmp = action; tmp->next; tmp = tmp->next)
  324. ;
  325. else {
  326. restore_flags(flags);
  327. return -EBUSY;
  328. }
  329. action = NULL; /* Or else! */
  330. }
  332. /* If this is flagged as statically allocated then we use our
  333.  * private struct which is never freed.
  334.  */
  335. if(irqflags & SA_STATIC_ALLOC) {
  336.     if(static_irq_count < MAX_STATIC_ALLOC)
  337. action = &static_irqaction[static_irq_count++];
  338.     else
  339. printk("Request for IRQ%d (%s) SA_STATIC_ALLOC failed "
  340.        "using kmallocn", irq, name);
  341. }
  342. if(action == NULL)
  343.     action = (struct irqaction *)kmalloc(sizeof(struct irqaction),
  344.  GFP_KERNEL);
  346. if(!action) { 
  347. restore_flags(flags);
  348. return -ENOMEM;
  349. }
  351. if (bucket == &pil0_dummy_bucket) {
  352. bucket->irq_info = action;
  353. bucket->flags |= IBF_ACTIVE;
  354. } else {
  355. if((bucket->flags & IBF_ACTIVE) != 0) {
  356. void *orig = bucket->irq_info;
  357. void **vector = NULL;
  359. if((bucket->flags & IBF_PCI) == 0) {
  360. printk("IRQ: Trying to share non-PCI bucket.n");
  361. goto free_and_ebusy;
  362. }
  363. if((bucket->flags & IBF_MULTI) == 0) {
  364. vector = kmalloc(sizeof(void *) * 4, GFP_KERNEL);
  365. if(vector == NULL)
  366. goto free_and_enomem;
  368. /* We might have slept. */
  369. if ((bucket->flags & IBF_MULTI) != 0) {
  370. int ent;
  372. kfree(vector);
  373. vector = (void **)bucket->irq_info;
  374. for(ent = 0; ent < 4; ent++) {
  375. if (vector[ent] == NULL) {
  376. vector[ent] = action;
  377. break;
  378. }
  379. }
  380. if (ent == 4)
  381. goto free_and_ebusy;
  382. } else {
  383. vector[0] = orig;
  384. vector[1] = action;
  385. vector[2] = NULL;
  386. vector[3] = NULL;
  387. bucket->irq_info = vector;
  388. bucket->flags |= IBF_MULTI;
  389. }
  390. } else {
  391. int ent;
  393. vector = (void **)orig;
  394. for(ent = 0; ent < 4; ent++) {
  395. if(vector[ent] == NULL) {
  396. vector[ent] = action;
  397. break;
  398. }
  399. }
  400. if (ent == 4)
  401. goto free_and_ebusy;
  402. }
  403. } else {
  404. bucket->irq_info = action;
  405. bucket->flags |= IBF_ACTIVE;
  406. }
  407. pending = bucket->pending;
  408. if(pending)
  409. bucket->pending = 0;
  410. }
  412. action->handler = handler;
  413. action->flags = irqflags;
  414. action->name = name;
  415. action->next = NULL;
  416. action->dev_id = dev_id;
  417. put_ino_in_irqaction(action, irq);
  418. put_smpaff_in_irqaction(action, 0);
  420. if(tmp)
  421. tmp->next = action;
  422. else
  423. *(bucket->pil + irq_action) = action;
  425. enable_irq(irq);
  427. /* We ate the IVEC already, this makes sure it does not get lost. */
  428. if(pending) {
  429. atomic_bucket_insert(bucket);
  430. set_softint(1 << bucket->pil);
  431. }
  432. restore_flags(flags);
  433. if ((bucket != &pil0_dummy_bucket) && (!(irqflags & SA_STATIC_ALLOC)))
  434. register_irq_proc(__irq_ino(irq));
  436. #ifdef CONFIG_SMP
  437. distribute_irqs();
  438. #endif
  439. return 0;
  441. free_and_ebusy:
  442. kfree(action);
  443. restore_flags(flags);
  444. return -EBUSY;
  446. free_and_enomem:
  447. kfree(action);
  448. restore_flags(flags);
  449. return -ENOMEM;
  450. }
  452. void free_irq(unsigned int irq, void *dev_id)
  453. {
  454. struct irqaction *action;
  455. struct irqaction *tmp = NULL;
  456. unsigned long flags;
  457. struct ino_bucket *bucket = __bucket(irq), *bp;
  459. if ((bucket != &pil0_dummy_bucket) &&
  460.     (bucket < &ivector_table[0] ||
  461.      bucket >= &ivector_table[NUM_IVECS])) {
  462. unsigned int *caller;
  464. __asm__ __volatile__("mov %%i7, %0" : "=r" (caller));
  465. printk(KERN_CRIT "free_irq: Old style IRQ removal attempt "
  466.        "from %p, irq %08x.n", caller, irq);
  467. return;
  468. }
  470. action = *(bucket->pil + irq_action);
  471. if(!action->handler) {
  472. printk("Freeing free IRQ %dn", bucket->pil);
  473. return;
  474. }
  475. if(dev_id) {
  476. for( ; action; action = action->next) {
  477. if(action->dev_id == dev_id)
  478. break;
  479. tmp = action;
  480. }
  481. if(!action) {
  482. printk("Trying to free free shared IRQ %dn", bucket->pil);
  483. return;
  484. }
  485. } else if(action->flags & SA_SHIRQ) {
  486. printk("Trying to free shared IRQ %d with NULL device IDn", bucket->pil);
  487. return;
  488. }
  490. if(action->flags & SA_STATIC_ALLOC) {
  491. printk("Attempt to free statically allocated IRQ %d (%s)n",
  492.        bucket->pil, action->name);
  493. return;
  494. }
  496. save_and_cli(flags);
  497. if(action && tmp)
  498. tmp->next = action->next;
  499. else
  500. *(bucket->pil + irq_action) = action->next;
  502. if (bucket != &pil0_dummy_bucket) {
  503. unsigned long imap = bucket->imap;
  504. void **vector, *orig;
  505. int ent;
  507. orig = bucket->irq_info;
  508. vector = (void **)orig;
  510. if ((bucket->flags & IBF_MULTI) != 0) {
  511. int other = 0;
  512. void *orphan = NULL;
  513. for(ent = 0; ent < 4; ent++) {
  514. if(vector[ent] == action)
  515. vector[ent] = NULL;
  516. else if(vector[ent] != NULL) {
  517. orphan = vector[ent];
  518. other++;
  519. }
  520. }
  522. /* Only free when no other shared irq
  523.  * uses this bucket.
  524.  */
  525. if(other) {
  526. if (other == 1) {
  527. /* Convert back to non-shared bucket. */
  528. bucket->irq_info = orphan;
  529. bucket->flags &= ~(IBF_MULTI);
  530. kfree(vector);
  531. }
  532. goto out;
  533. }
  534. } else {
  535. bucket->irq_info = NULL;
  536. }
  538. /* This unique interrupt source is now inactive. */
  539. bucket->flags &= ~IBF_ACTIVE;
  541. /* See if any other buckets share this bucket's IMAP
  542.  * and are still active.
  543.  */
  544. for(ent = 0; ent < NUM_IVECS; ent++) {
  545. bp = &ivector_table[ent];
  546. if(bp != bucket &&
  547.    bp->imap == imap &&
  548.    (bp->flags & IBF_ACTIVE) != 0)
  549. break;
  550. }
  552. /* Only disable when no other sub-irq levels of
  553.  * the same IMAP are active.
  554.  */
  555. if (ent == NUM_IVECS)
  556. disable_irq(irq);
  557. }
  559. out:
  560. kfree(action);
  561. restore_flags(flags);
  562. }
  564. #ifdef CONFIG_SMP
  566. /* Who has the global irq brlock */
  567. unsigned char global_irq_holder = NO_PROC_ID;
  569. static void show(char * str)
  570. {
  571. int cpu = smp_processor_id();
  572. int i;
  574. printk("n%s, CPU %d:n", str, cpu);
  575. printk("irq:  %d [ ", irqs_running());
  576. for (i = 0; i < smp_num_cpus; i++)
  577. printk("%u ", __brlock_array[i][BR_GLOBALIRQ_LOCK]);
  578. printk("]nbh:   %d [ ",
  579.        (spin_is_locked(&global_bh_lock) ? 1 : 0));
  580. for (i = 0; i < smp_num_cpus; i++)
  581. printk("%u ", local_bh_count(i));
  582. printk("]n");
  583. }
  585. #define MAXCOUNT 100000000
  587. #if 0
  588. #define SYNC_OTHER_ULTRAS(x) udelay(x+1)
  589. #else
  590. #define SYNC_OTHER_ULTRAS(x) membar("#Sync");
  591. #endif
  593. void synchronize_irq(void)
  594. {
  595. if (irqs_running()) {
  596. cli();
  597. sti();
  598. }
  599. }
  601. static inline void get_irqlock(int cpu)
  602. {
  603. int count;
  605. if ((unsigned char)cpu == global_irq_holder)
  606. return;
  608. count = MAXCOUNT;
  609. again:
  610. br_write_lock(BR_GLOBALIRQ_LOCK);
  611. for (;;) {
  612. spinlock_t *lock;
  614. if (!irqs_running() &&
  615.     (local_bh_count(smp_processor_id()) || !spin_is_locked(&global_bh_lock)))
  616. break;
  618. br_write_unlock(BR_GLOBALIRQ_LOCK);
  619. lock = &__br_write_locks[BR_GLOBALIRQ_LOCK].lock;
  620. while (irqs_running() ||
  621.        spin_is_locked(lock) ||
  622.        (!local_bh_count(smp_processor_id()) && spin_is_locked(&global_bh_lock))) {
  623. if (!--count) {
  624. show("get_irqlock");
  625. count = (~0 >> 1);
  626. }
  627. __sti();
  628. SYNC_OTHER_ULTRAS(cpu);
  629. __cli();
  630. }
  631. goto again;
  632. }
  634. global_irq_holder = cpu;
  635. }
  637. void __global_cli(void)
  638. {
  639. unsigned long flags;
  641. __save_flags(flags);
  642. if(flags == 0) {
  643. int cpu = smp_processor_id();
  644. __cli();
  645. if (! local_irq_count(cpu))
  646. get_irqlock(cpu);
  647. }
  648. }
  650. void __global_sti(void)
  651. {
  652. int cpu = smp_processor_id();
  654. if (! local_irq_count(cpu))
  655. release_irqlock(cpu);
  656. __sti();
  657. }
  659. unsigned long __global_save_flags(void)
  660. {
  661. unsigned long flags, local_enabled, retval;
  663. __save_flags(flags);
  664. local_enabled = ((flags == 0) ? 1 : 0);
  665. retval = 2 + local_enabled;
  666. if (! local_irq_count(smp_processor_id())) {
  667. if (local_enabled)
  668. retval = 1;
  669. if (global_irq_holder == (unsigned char) smp_processor_id())
  670. retval = 0;
  671. }
  672. return retval;
  673. }
  675. void __global_restore_flags(unsigned long flags)
  676. {
  677. switch (flags) {
  678. case 0:
  679. __global_cli();
  680. break;
  681. case 1:
  682. __global_sti();
  683. break;
  684. case 2:
  685. __cli();
  686. break;
  687. case 3:
  688. __sti();
  689. break;
  690. default:
  691. {
  692. unsigned long pc;
  693. __asm__ __volatile__("mov %%i7, %0" : "=r" (pc));
  694. printk("global_restore_flags: Bogon flags(%016lx) caller %016lxn",
  695.        flags, pc);
  696. }
  697. }
  698. }
  700. #endif /* CONFIG_SMP */
  702. void catch_disabled_ivec(struct pt_regs *regs)
  703. {
  704. int cpu = smp_processor_id();
  705. struct ino_bucket *bucket = __bucket(*irq_work(cpu, 0));
  707. /* We can actually see this on Ultra/PCI PCI cards, which are bridges
  708.  * to other devices.  Here a single IMAP enabled potentially multiple
  709.  * unique interrupt sources (which each do have a unique ICLR register.
  710.  *
  711.  * So what we do is just register that the IVEC arrived, when registered
  712.  * for real the request_irq() code will check the bit and signal
  713.  * a local CPU interrupt for it.
  714.  */
  715. #if 0
  716. printk("IVEC: Spurious interrupt vector (%x) received at (%016lx)n",
  717.        bucket - &ivector_table[0], regs->tpc);
  718. #endif
  719. *irq_work(cpu, 0) = 0;
  720. bucket->pending = 1;
  721. }
  723. /* Tune this... */
  724. #define FORWARD_VOLUME 12
  726. #ifdef CONFIG_SMP
  728. static inline void redirect_intr(int cpu, struct ino_bucket *bp)
  729. {
  730. /* Ok, here is what is going on:
  731.  * 1) Retargeting IRQs on Starfire is very
  732.  *    expensive so just forget about it on them.
  733.  * 2) Moving around very high priority interrupts
  734.  *    is a losing game.
  735.  * 3) If the current cpu is idle, interrupts are
  736.  *    useful work, so keep them here.  But do not
  737.  *    pass to our neighbour if he is not very idle.
  738.  * 4) If sysadmin explicitly asks for directed intrs,
  739.  *    Just Do It.
  740.  */
  741. struct irqaction *ap = bp->irq_info;
  742. unsigned long cpu_mask = get_smpaff_in_irqaction(ap);
  743. unsigned int buddy, ticks;
  745. if (cpu_mask == 0)
  746. cpu_mask = ~0UL;
  748. if (this_is_starfire != 0 ||
  749.     bp->pil >= 10 || current->pid == 0)
  750. goto out;
  752. /* 'cpu' is the MID (ie. UPAID), calculate the MID
  753.  * of our buddy.
  754.  */
  755. buddy = cpu_number_map(cpu) + 1;
  756. if (buddy >= NR_CPUS ||
  757.     cpu_logical_map(buddy) == -1)
  758. buddy = 0;
  760. ticks = 0;
  761. while ((cpu_mask & (1UL << buddy)) == 0) {
  762. buddy++;
  763. if (buddy >= NR_CPUS ||
  764.     cpu_logical_map(buddy) == -1)
  765. buddy = cpu_logical_map(0);
  766. if (++ticks > NR_CPUS) {
  767. put_smpaff_in_irqaction(ap, 0);
  768. goto out;
  769. }
  770. }
  772. if (buddy == cpu_number_map(cpu))
  773. goto out;
  775. buddy = cpu_logical_map(buddy);
  777. /* Voo-doo programming. */
  778. if (cpu_data[buddy].idle_volume < FORWARD_VOLUME)
  779. goto out;
  781. /* This just so happens to be correct on Cheetah
  782.  * at the moment.
  783.  */
  784. buddy <<= 26;
  786. /* Push it to our buddy. */
  787. upa_writel(buddy | IMAP_VALID, bp->imap);
  789. out:
  790. return;
  791. }
  793. #endif
  795. void handler_irq(int irq, struct pt_regs *regs)
  796. {
  797. struct ino_bucket *bp, *nbp;
  798. int cpu = smp_processor_id();
  800. #ifndef CONFIG_SMP
  801. /*
  802.  * Check for TICK_INT on level 14 softint.
  803.  */
  804. {
  805. unsigned long clr_mask = 1 << irq;
  806. unsigned long tick_mask;
  808. if (SPARC64_USE_STICK)
  809. tick_mask = (1UL << 16);
  810. else
  811. tick_mask = (1UL << 0);
  812. if ((irq == 14) && (get_softint() & tick_mask)) {
  813. irq = 0;
  814. clr_mask = tick_mask;
  815. }
  816. clear_softint(clr_mask);
  817. }
  818. #else
  819. int should_forward = 1;
  821. clear_softint(1 << irq);
  822. #endif
  824. irq_enter(cpu, irq);
  825. kstat.irqs[cpu][irq]++;
  827. #ifdef CONFIG_PCI
  828. if (irq == 9)
  829. kbd_pt_regs = regs;
  830. #endif
  832. /* Sliiiick... */
  833. #ifndef CONFIG_SMP
  834. bp = ((irq != 0) ?
  835.       __bucket(xchg32(irq_work(cpu, irq), 0)) :
  836.       &pil0_dummy_bucket);
  837. #else
  838. bp = __bucket(xchg32(irq_work(cpu, irq), 0));
  839. #endif
  840. for ( ; bp != NULL; bp = nbp) {
  841. unsigned char flags = bp->flags;
  842. unsigned char random = 0;
  844. nbp = __bucket(bp->irq_chain);
  845. bp->irq_chain = 0;
  847. if ((flags & IBF_ACTIVE) != 0) {
  848. #ifdef CONFIG_PCI
  849. if ((flags & IBF_DMA_SYNC) != 0) {
  850. upa_readl(dma_sync_reg_table[bp->synctab_ent]);
  851. upa_readq(pci_dma_wsync);
  852. }
  853. #endif
  854. if ((flags & IBF_MULTI) == 0) {
  855. struct irqaction *ap = bp->irq_info;
  856. ap->handler(__irq(bp), ap->dev_id, regs);
  857. random |= ap->flags & SA_SAMPLE_RANDOM;
  858. } else {
  859. void **vector = (void **)bp->irq_info;
  860. int ent;
  861. for (ent = 0; ent < 4; ent++) {
  862. struct irqaction *ap = vector[ent];
  863. if (ap != NULL) {
  864. ap->handler(__irq(bp), ap->dev_id, regs);
  865. random |= ap->flags & SA_SAMPLE_RANDOM;
  866. }
  867. }
  868. }
  869. /* Only the dummy bucket lacks IMAP/ICLR. */
  870. if (bp->pil != 0) {
  871. #ifdef CONFIG_SMP
  872. if (should_forward) {
  873. redirect_intr(cpu, bp);
  874. should_forward = 0;
  875. }
  876. #endif
  877. upa_writel(ICLR_IDLE, bp->iclr);
  878. /* Test and add entropy */
  879. if (random)
  880. add_interrupt_randomness(irq);
  881. }
  882. } else
  883. bp->pending = 1;
  884. }
  885. irq_exit(cpu, irq);
  886. }
  888. #ifdef CONFIG_BLK_DEV_FD
  889. extern void floppy_interrupt(int irq, void *dev_cookie, struct pt_regs *regs);
  891. void sparc_floppy_irq(int irq, void *dev_cookie, struct pt_regs *regs)
  892. {
  893. struct irqaction *action = *(irq + irq_action);
  894. struct ino_bucket *bucket;
  895. int cpu = smp_processor_id();
  897. irq_enter(cpu, irq);
  898. kstat.irqs[cpu][irq]++;
  900. *(irq_work(cpu, irq)) = 0;
  901. bucket = get_ino_in_irqaction(action) + ivector_table;
  903. floppy_interrupt(irq, dev_cookie, regs);
  904. upa_writel(ICLR_IDLE, bucket->iclr);
  906. irq_exit(cpu, irq);
  907. }
  908. #endif
  910. /* The following assumes that the branch lies before the place we
  911.  * are branching to.  This is the case for a trap vector...
  912.  * You have been warned.
  913.  */
  914. #define SPARC_BRANCH(dest_addr, inst_addr) 
  915.           (0x10800000 | ((((dest_addr)-(inst_addr))>>2)&0x3fffff))
  917. #define SPARC_NOP (0x01000000)
  919. static void install_fast_irq(unsigned int cpu_irq,
  920.      void (*handler)(int, void *, struct pt_regs *))
  921. {
  922. extern unsigned long sparc64_ttable_tl0;
  923. unsigned long ttent = (unsigned long) &sparc64_ttable_tl0;
  924. unsigned int *insns;
  926. ttent += 0x820;
  927. ttent += (cpu_irq - 1) << 5;
  928. insns = (unsigned int *) ttent;
  929. insns[0] = SPARC_BRANCH(((unsigned long) handler),
  930. ((unsigned long)&insns[0]));
  931. insns[1] = SPARC_NOP;
  932. __asm__ __volatile__("membar #StoreStore; flush %0" : : "r" (ttent));
  933. }
  935. int request_fast_irq(unsigned int irq,
  936.      void (*handler)(int, void *, struct pt_regs *),
  937.      unsigned long irqflags, const char *name, void *dev_id)
  938. {
  939. struct irqaction *action;
  940. struct ino_bucket *bucket = __bucket(irq);
  941. unsigned long flags;
  943. /* No pil0 dummy buckets allowed here. */
  944. if (bucket < &ivector_table[0] ||
  945.     bucket >= &ivector_table[NUM_IVECS]) {
  946. unsigned int *caller;
  948. __asm__ __volatile__("mov %%i7, %0" : "=r" (caller));
  949. printk(KERN_CRIT "request_fast_irq: Old style IRQ registry attempt "
  950.        "from %p, irq %08x.n", caller, irq);
  951. return -EINVAL;
  952. }
  954. if(!handler)
  955. return -EINVAL;
  957. if ((bucket->pil == 0) || (bucket->pil == 14)) {
  958. printk("request_fast_irq: Trying to register shared IRQ 0 or 14.n");
  959. return -EBUSY;
  960. }
  962. action = *(bucket->pil + irq_action);
  963. if(action) {
  964. if(action->flags & SA_SHIRQ)
  965. panic("Trying to register fast irq when already shared.n");
  966. if(irqflags & SA_SHIRQ)
  967. panic("Trying to register fast irq as shared.n");
  968. printk("request_fast_irq: Trying to register yet already owned.n");
  969. return -EBUSY;
  970. }
  972. /*
  973.  * We do not check for SA_SAMPLE_RANDOM in this path. Neither do we
  974.  * support smp intr affinity in this path.
  975.  */
  976. save_and_cli(flags);
  977. if(irqflags & SA_STATIC_ALLOC) {
  978. if(static_irq_count < MAX_STATIC_ALLOC)
  979. action = &static_irqaction[static_irq_count++];
  980. else
  981. printk("Request for IRQ%d (%s) SA_STATIC_ALLOC failed "
  982.        "using kmallocn", bucket->pil, name);
  983. }
  984. if(action == NULL)
  985. action = (struct irqaction *)kmalloc(sizeof(struct irqaction),
  986.      GFP_KERNEL);
  987. if(!action) {
  988. restore_flags(flags);
  989. return -ENOMEM;
  990. }
  991. install_fast_irq(bucket->pil, handler);
  993. bucket->irq_info = action;
  994. bucket->flags |= IBF_ACTIVE;
  996. action->handler = handler;
  997. action->flags = irqflags;
  998. action->dev_id = NULL;
  999. action->name = name;
  1000. action->next = NULL;
  1001. put_ino_in_irqaction(action, irq);
  1002. put_smpaff_in_irqaction(action, 0);
  1004. *(bucket->pil + irq_action) = action;
  1005. enable_irq(irq);
  1007. restore_flags(flags);
  1009. #ifdef CONFIG_SMP
  1010. distribute_irqs();
  1011. #endif
  1012. return 0;
  1013. }
  1015. /* We really don't need these at all on the Sparc.  We only have
  1016.  * stubs here because they are exported to modules.
  1017.  */
  1018. unsigned long probe_irq_on(void)
  1019. {
  1020. return 0;
  1021. }
  1023. int probe_irq_off(unsigned long mask)
  1024. {
  1025. return 0;
  1026. }
  1028. /* This is gets the master TICK_INT timer going. */
  1029. void init_timers(void (*cfunc)(int, void *, struct pt_regs *),
  1030.  unsigned long *clock)
  1031. {
  1032. unsigned long pstate;
  1033. extern unsigned long timer_tick_offset;
  1034. int node, err;
  1035. #ifdef CONFIG_SMP
  1036. extern void smp_tick_init(void);
  1037. #endif
  1039. if (!SPARC64_USE_STICK) {
  1040. node = linux_cpus[0].prom_node;
  1041. *clock = prom_getint(node, "clock-frequency");
  1042. } else {
  1043. node = prom_root_node;
  1044. *clock = prom_getint(node, "stick-frequency");
  1045. }
  1046. timer_tick_offset = *clock / HZ;
  1047. #ifdef CONFIG_SMP
  1048. smp_tick_init();
  1049. #endif
  1051. /* Register IRQ handler. */
  1052. err = request_irq(build_irq(0, 0, 0UL, 0UL), cfunc, SA_STATIC_ALLOC,
  1053.   "timer", NULL);
  1055. if(err) {
  1056. prom_printf("Serious problem, cannot register TICK_INTn");
  1057. prom_halt();
  1058. }
  1060. /* Guarentee that the following sequences execute
  1061.  * uninterrupted.
  1062.  */
  1063. __asm__ __volatile__("rdpr %%pstate, %0nt"
  1064.      "wrpr %0, %1, %%pstate"
  1065.      : "=r" (pstate)
  1066.      : "i" (PSTATE_IE));
  1068. /* Set things up so user can access tick register for profiling
  1069.  * purposes.  Also workaround BB_ERRATA_1 by doing a dummy
  1070.  * read back of %tick after writing it.
  1071.  */
  1072. __asm__ __volatile__(
  1073. " sethi %%hi(0x80000000), %%g1n"
  1074. " ba,pt %%xcc, 1fn"
  1075. "  sllx %%g1, 32, %%g1n"
  1076. " .align 64n"
  1077. "1: rd %%tick, %%g2n"
  1078. " add %%g2, 6, %%g2n"
  1079. " andn %%g2, %%g1, %%g2n"
  1080. " wrpr %%g2, 0, %%tickn"
  1081. " rdpr %%tick, %%g0"
  1082. : /* no outputs */
  1083. : /* no inputs */
  1084. : "g1", "g2");
  1086. /* Workaround for Spitfire Errata (#54 I think??), I discovered
  1087.  * this via Sun BugID 4008234, mentioned in Solaris-2.5.1 patch
  1088.  * number 103640.
  1089.  *
  1090.  * On Blackbird writes to %tick_cmpr can fail, the
  1091.  * workaround seems to be to execute the wr instruction
  1092.  * at the start of an I-cache line, and perform a dummy
  1093.  * read back from %tick_cmpr right after writing to it. -DaveM
  1094.  */
  1095. if (!SPARC64_USE_STICK) {
  1096. __asm__ __volatile__(
  1097. " rd %%tick, %%g1n"
  1098. " ba,pt %%xcc, 1fn"
  1099. "  add %%g1, %0, %%g1n"
  1100. " .align 64n"
  1101. "1: wr %%g1, 0x0, %%tick_cmprn"
  1102. " rd %%tick_cmpr, %%g0"
  1103. : /* no outputs */
  1104. : "r" (timer_tick_offset)
  1105. : "g1");
  1106. } else {
  1107. /* Let the user get at STICK too. */
  1108. __asm__ __volatile__(
  1109. " sethi %%hi(0x80000000), %%g1n"
  1110. " sllx %%g1, 32, %%g1n"
  1111. " rd %%asr24, %%g2n"
  1112. " andn %%g2, %%g1, %%g2n"
  1113. " wr %%g2, 0, %%asr24"
  1114. : /* no outputs */
  1115. : /* no inputs */
  1116. : "g1", "g2");
  1118. __asm__ __volatile__(
  1119. " rd %%asr24, %%g1n"
  1120. " add %%g1, %0, %%g1n"
  1121. " wr %%g1, 0x0, %%asr25"
  1122. : /* no outputs */
  1123. : "r" (timer_tick_offset)
  1124. : "g1");
  1125. }
  1127. /* Restore PSTATE_IE. */
  1128. __asm__ __volatile__("wrpr %0, 0x0, %%pstate"
  1129.      : /* no outputs */
  1130.      : "r" (pstate));
  1132. sti();
  1133. }
  1135. #ifdef CONFIG_SMP
  1136. static int retarget_one_irq(struct irqaction *p, int goal_cpu)
  1137. {
  1138. struct ino_bucket *bucket = get_ino_in_irqaction(p) + ivector_table;
  1139. unsigned long imap = bucket->imap;
  1140. unsigned int tid;
  1142. if (tlb_type == cheetah) {
  1143. tid = __cpu_logical_map[goal_cpu] << 26;
  1144. tid &= IMAP_AID_SAFARI;
  1145. } else if (this_is_starfire == 0) {
  1146. tid = __cpu_logical_map[goal_cpu] << 26;
  1147. tid &= IMAP_TID_UPA;
  1148. } else {
  1149. tid = (starfire_translate(imap, __cpu_logical_map[goal_cpu]) << 26);
  1150. tid &= IMAP_TID_UPA;
  1151. }
  1152. upa_writel(tid | IMAP_VALID, imap);
  1154. goal_cpu++;
  1155. if(goal_cpu >= NR_CPUS ||
  1156.    __cpu_logical_map[goal_cpu] == -1)
  1157. goal_cpu = 0;
  1158. return goal_cpu;
  1159. }
  1161. /* Called from request_irq. */
  1162. static void distribute_irqs(void)
  1163. {
  1164. unsigned long flags;
  1165. int cpu, level;
  1167. save_and_cli(flags);
  1168. cpu = 0;
  1170. /*
  1171.  * Skip the timer at [0], and very rare error/power intrs at [15].
  1172.  * Also level [12], it causes problems on Ex000 systems.
  1173.  */
  1174. for(level = 1; level < NR_IRQS; level++) {
  1175. struct irqaction *p = irq_action[level];
  1176. if (level == 12) continue;
  1177. while(p) {
  1178. cpu = retarget_one_irq(p, cpu);
  1179. p = p->next;
  1180. }
  1181. }
  1182. restore_flags(flags);
  1183. }
  1184. #endif
  1187. struct sun5_timer *prom_timers;
  1188. static u64 prom_limit0, prom_limit1;
  1190. static void map_prom_timers(void)
  1191. {
  1192. unsigned int addr[3];
  1193. int tnode, err;
  1195. /* PROM timer node hangs out in the top level of device siblings... */
  1196. tnode = prom_finddevice("/counter-timer");
  1198. /* Assume if node is not present, PROM uses different tick mechanism
  1199.  * which we should not care about.
  1200.  */
  1201. if(tnode == 0 || tnode == -1) {
  1202. prom_timers = (struct sun5_timer *) 0;
  1203. return;
  1204. }
  1206. /* If PROM is really using this, it must be mapped by him. */
  1207. err = prom_getproperty(tnode, "address", (char *)addr, sizeof(addr));
  1208. if(err == -1) {
  1209. prom_printf("PROM does not have timer mapped, trying to continue.n");
  1210. prom_timers = (struct sun5_timer *) 0;
  1211. return;
  1212. }
  1213. prom_timers = (struct sun5_timer *) ((unsigned long)addr[0]);
  1214. }
  1216. static void kill_prom_timer(void)
  1217. {
  1218. if(!prom_timers)
  1219. return;
  1221. /* Save them away for later. */
  1222. prom_limit0 = prom_timers->limit0;
  1223. prom_limit1 = prom_timers->limit1;
  1225. /* Just as in sun4c/sun4m PROM uses timer which ticks at IRQ 14.
  1226.  * We turn both off here just to be paranoid.
  1227.  */
  1228. prom_timers->limit0 = 0;
  1229. prom_timers->limit1 = 0;
  1231. /* Wheee, eat the interrupt packet too... */
  1232. __asm__ __volatile__(
  1233. " mov 0x40, %%g2n"
  1234. " ldxa [%%g0] %0, %%g1n"
  1235. " ldxa [%%g2] %1, %%g1n"
  1236. " stxa %%g0, [%%g0] %0n"
  1237. " membar #Syncn"
  1238. : /* no outputs */
  1239. : "i" (ASI_INTR_RECEIVE), "i" (ASI_INTR_R)
  1240. : "g1", "g2");
  1241. }
  1243. void enable_prom_timer(void)
  1244. {
  1245. if(!prom_timers)
  1246. return;
  1248. /* Set it to whatever was there before. */
  1249. prom_timers->limit1 = prom_limit1;
  1250. prom_timers->count1 = 0;
  1251. prom_timers->limit0 = prom_limit0;
  1252. prom_timers->count0 = 0;
  1253. }
  1255. void __init init_IRQ(void)
  1256. {
  1257. static int called = 0;
  1259. if (called == 0) {
  1260. called = 1;
  1261. map_prom_timers();
  1262. kill_prom_timer();
  1263. memset(&ivector_table[0], 0, sizeof(ivector_table));
  1264. #ifndef CONFIG_SMP
  1265. memset(&__up_workvec[0], 0, sizeof(__up_workvec));
  1266. #endif
  1267. }
  1269. /* We need to clear any IRQ's pending in the soft interrupt
  1270.  * registers, a spurious one could be left around from the
  1271.  * PROM timer which we just disabled.
  1272.  */
  1273. clear_softint(get_softint());
  1275. /* Now that ivector table is initialized, it is safe
  1276.  * to receive IRQ vector traps.  We will normally take
  1277.  * one or two right now, in case some device PROM used
  1278.  * to boot us wants to speak to us.  We just ignore them.
  1279.  */
  1280. __asm__ __volatile__("rdpr %%pstate, %%g1nt"
  1281.      "or %%g1, %0, %%g1nt"
  1282.      "wrpr %%g1, 0x0, %%pstate"
  1283.      : /* No outputs */
  1284.      : "i" (PSTATE_IE)
  1285.      : "g1");
  1286. }
  1288. static struct proc_dir_entry * root_irq_dir;
  1289. static struct proc_dir_entry * irq_dir [NUM_IVECS];
  1291. #ifdef CONFIG_SMP
  1293. #define HEX_DIGITS 16
  1295. static unsigned int parse_hex_value (const char *buffer,
  1296. unsigned long count, unsigned long *ret)
  1297. {
  1298. unsigned char hexnum [HEX_DIGITS];
  1299. unsigned long value;
  1300. int i;
  1302. if (!count)
  1303. return -EINVAL;
  1304. if (count > HEX_DIGITS)
  1305. count = HEX_DIGITS;
  1306. if (copy_from_user(hexnum, buffer, count))
  1307. return -EFAULT;
  1309. /*
  1310.  * Parse the first 8 characters as a hex string, any non-hex char
  1311.  * is end-of-string. '00e1', 'e1', '00E1', 'E1' are all the same.
  1312.  */
  1313. value = 0;
  1315. for (i = 0; i < count; i++) {
  1316. unsigned int c = hexnum[i];
  1318. switch (c) {
  1319. case '0' ... '9': c -= '0'; break;
  1320. case 'a' ... 'f': c -= 'a'-10; break;
  1321. case 'A' ... 'F': c -= 'A'-10; break;
  1322. default:
  1323. goto out;
  1324. }
  1325. value = (value << 4) | c;
  1326. }
  1327. out:
  1328. *ret = value;
  1329. return 0;
  1330. }
  1332. static unsigned long hw_to_logical(unsigned long mask)
  1333. {
  1334. unsigned long new_mask = 0UL;
  1335. int i;
  1337. for (i = 0; i < NR_CPUS; i++) {
  1338. if (mask & (1UL << i)) {
  1339. int logical = cpu_number_map(i);
  1341. new_mask |= (1UL << logical);
  1342. }
  1343. }
  1345. return new_mask;
  1346. }
  1348. static unsigned long logical_to_hw(unsigned long mask)
  1349. {
  1350. unsigned long new_mask = 0UL;
  1351. int i;
  1353. for (i = 0; i < NR_CPUS; i++) {
  1354. if (mask & (1UL << i)) {
  1355. int hw = cpu_logical_map(i);
  1357. new_mask |= (1UL << hw);
  1358. }
  1359. }
  1361. return new_mask;
  1362. }
  1364. static int irq_affinity_read_proc (char *page, char **start, off_t off,
  1365. int count, int *eof, void *data)
  1366. {
  1367. struct ino_bucket *bp = ivector_table + (long)data;
  1368. struct irqaction *ap = bp->irq_info;
  1369. unsigned long mask = get_smpaff_in_irqaction(ap);
  1371. mask = logical_to_hw(mask);
  1373. if (count < HEX_DIGITS+1)
  1374. return -EINVAL;
  1375. return sprintf (page, "%016lxn", mask == 0 ? ~0UL : mask);
  1376. }
  1378. static inline void set_intr_affinity(int irq, unsigned long hw_aff)
  1379. {
  1380. struct ino_bucket *bp = ivector_table + irq;
  1381. unsigned long aff = hw_to_logical(hw_aff);
  1383. /*
  1384.  * Users specify affinity in terms of cpu ids, which is what
  1385.  * is displayed via /proc/cpuinfo. As soon as we do this, 
  1386.  * handler_irq() might see and take action.
  1387.  */
  1388. put_smpaff_in_irqaction((struct irqaction *)bp->irq_info, aff);
  1390. /* Migration is simply done by the next cpu to service this
  1391.  * interrupt.
  1392.  */
  1393. }
  1395. static int irq_affinity_write_proc (struct file *file, const char *buffer,
  1396. unsigned long count, void *data)
  1397. {
  1398. int irq = (long) data, full_count = count, err;
  1399. unsigned long new_value;
  1401. err = parse_hex_value(buffer, count, &new_value);
  1403. /*
  1404.  * Do not allow disabling IRQs completely - it's a too easy
  1405.  * way to make the system unusable accidentally :-) At least
  1406.  * one online CPU still has to be targeted.
  1407.  */
  1408. new_value &= cpu_online_map;
  1409. if (!new_value)
  1410. return -EINVAL;
  1412. set_intr_affinity(irq, new_value);
  1414. return full_count;
  1415. }
  1417. #endif
  1419. #define MAX_NAMELEN 10
  1421. static void register_irq_proc (unsigned int irq)
  1422. {
  1423. char name [MAX_NAMELEN];
  1425. if (!root_irq_dir || irq_dir[irq])
  1426. return;
  1428. memset(name, 0, MAX_NAMELEN);
  1429. sprintf(name, "%x", irq);
  1431. /* create /proc/irq/1234 */
  1432. irq_dir[irq] = proc_mkdir(name, root_irq_dir);
  1434. #ifdef CONFIG_SMP
  1435. /* XXX SMP affinity not supported on starfire yet. */
  1436. if (this_is_starfire == 0) {
  1437. struct proc_dir_entry *entry;
  1439. /* create /proc/irq/1234/smp_affinity */
  1440. entry = create_proc_entry("smp_affinity", 0600, irq_dir[irq]);
  1442. if (entry) {
  1443. entry->nlink = 1;
  1444. entry->data = (void *)(long)irq;
  1445. entry->read_proc = irq_affinity_read_proc;
  1446. entry->write_proc = irq_affinity_write_proc;
  1447. }
  1448. }
  1449. #endif
  1450. }
  1452. void init_irq_proc (void)
  1453. {
  1454. /* create /proc/irq */
  1455. root_irq_dir = proc_mkdir("irq", 0);
  1456. }