gsc.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:5k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  * Interrupt management for most GSC and related devices.
  3.  *
  4.  * (c) Copyright 1999 Alex deVries for The Puffin Group
  5.  * (c) Copyright 1999 Grant Grundler for Hewlett-Packard
  6.  * (c) Copyright 1999 Matthew Wilcox
  7.  * (c) Copyright 2000 Helge Deller
  8.  * (c) Copyright 2001 Matthew Wilcox for Hewlett-Packard
  9.  *
  10.  * This program is free software; you can redistribute it and/or modify
  11.  * it under the terms of the GNU General Public License as published by
  12.  *      the Free Software Foundation; either version 2 of the License, or
  13.  *      (at your option) any later version.
  14.  */
  15. #include <linux/bitops.h>
  16. #include <linux/config.h>
  17. #include <linux/errno.h>
  18. #include <linux/init.h>
  19. #include <linux/interrupt.h>
  20. #include <linux/ioport.h>
  21. #include <linux/slab.h>
  22. #include <linux/types.h>
  23. #include <asm/gsc.h>
  24. #include <asm/hardware.h>
  25. #include <asm/io.h>
  26. #include <asm/irq.h>
  27. #include "busdevice.h"
  28. #undef DEBUG
  29. #ifdef DEBUG
  30. #define DEBPRINTK printk
  31. #else
  32. #define DEBPRINTK(x,...)
  33. #endif
  34. int gsc_alloc_irq(struct gsc_irq *i)
  35. {
  36. int irq = txn_alloc_irq();
  37. if (irq < 0) {
  38. printk("cannot get irqn");
  39. return irq;
  40. }
  41. i->txn_addr = txn_alloc_addr(irq);
  42. i->txn_data = txn_alloc_data(irq, GSC_EIM_WIDTH);
  43. i->irq = irq;
  44. return irq;
  45. }
  46. int gsc_claim_irq(struct gsc_irq *i, int irq)
  47. {
  48. int c = irq;
  49. irq += IRQ_FROM_REGION(CPU_IRQ_REGION); /* virtualize the IRQ first */
  50. irq = txn_claim_irq(irq);
  51. if (irq < 0) {
  52. printk("cannot claim irq %dn", c);
  53. return irq;
  54. }
  55. i->txn_addr = txn_alloc_addr(irq);
  56. i->txn_data = txn_alloc_data(irq, GSC_EIM_WIDTH);
  57. i->irq = irq;
  58. return irq;
  59. }
  60. /* IRQ bits must be numbered from Most Significant Bit */
  61. #define GSC_FIX_IRQ(x) (31-(x))
  62. #define GSC_MASK_IRQ(x) (1<<(GSC_FIX_IRQ(x)))
  63. /* Common interrupt demultiplexer used by Asp, Lasi & Wax.  */
  64. void busdev_barked(int busdev_irq, void *dev, struct pt_regs *regs)
  65. {
  66. unsigned long irq;
  67. struct busdevice *busdev = (struct busdevice *) dev;
  68. /* 
  69.     Don't need to protect OFFSET_IRR with spinlock since this is
  70.     the only place it's touched.
  71.     Protect busdev_region by disabling this region's interrupts,
  72.     modifying the region, and then re-enabling the region.
  73. */
  74. irq = gsc_readl(busdev->hpa+OFFSET_IRR);
  75. if (irq == 0) {
  76. printk(KERN_ERR "%s: barking without apparent reason.n", busdev->name);
  77. } else {
  78. DEBPRINTK ("%s (0x%x) barked, mask=0x%x, irq=%dn", 
  79.     busdev->name, busdev->busdev_region->data.irqbase, 
  80.     irq, GSC_FIX_IRQ(ffs(irq))+1 );
  81. do_irq_mask(irq, busdev->busdev_region, regs);
  82. }
  83. }
  84. static void
  85. busdev_disable_irq(void *irq_dev, int irq)
  86. {
  87. /* Disable the IRQ line by clearing the bit in the IMR */
  88. u32 imr = gsc_readl(BUSDEV_DEV(irq_dev)->hpa+OFFSET_IMR);
  89. imr &= ~(GSC_MASK_IRQ(irq));
  90. DEBPRINTK( KERN_WARNING "%s(%p, %d) %s: IMR 0x%xn", 
  91.     __FUNCTION__, irq_dev, irq, BUSDEV_DEV(irq_dev)->name, imr);
  92. gsc_writel(imr, BUSDEV_DEV(irq_dev)->hpa+OFFSET_IMR);
  93. }
  94. static void
  95. busdev_enable_irq(void *irq_dev, int irq)
  96. {
  97. /* Enable the IRQ line by setting the bit in the IMR */
  98. unsigned long addr = BUSDEV_DEV(irq_dev)->hpa + OFFSET_IMR;
  99. u32 imr = gsc_readl(addr);
  100. imr |= GSC_MASK_IRQ(irq);
  101. DEBPRINTK (KERN_WARNING "%s(%p, %d) %s: IMR 0x%xn", 
  102.     __FUNCTION__, irq_dev, irq, BUSDEV_DEV(irq_dev)->name, imr);
  103. gsc_writel(imr, addr);
  104. // gsc_writel(~0L, addr);
  105. /* FIXME: read IPR to make sure the IRQ isn't already pending.
  106. **   If so, we need to read IRR and manually call do_irq_mask().
  107. **   This code should be shared with busdev_unmask_irq().
  108. */
  109. }
  110. static void
  111. busdev_mask_irq(void *irq_dev, int irq)
  112. {
  113. /* FIXME: Clear the IMR bit in busdev for that IRQ */
  114. }
  115. static void
  116. busdev_unmask_irq(void *irq_dev, int irq)
  117. {
  118. /* FIXME: Read IPR. Set the IMR bit in busdev for that IRQ.
  119.    call do_irq_mask() if IPR is non-zero
  120. */
  121. }
  122. struct irq_region_ops busdev_irq_ops = {
  123. disable_irq: busdev_disable_irq,
  124. enable_irq: busdev_enable_irq,
  125. mask_irq: busdev_mask_irq,
  126. unmask_irq: busdev_unmask_irq
  127. };
  128. int gsc_common_irqsetup(struct parisc_device *parent, struct busdevice *busdev)
  129. {
  130. struct resource *res;
  131. busdev->gsc = parent;
  132. /* the IRQs we simulate */
  133. busdev->busdev_region = alloc_irq_region(32, &busdev_irq_ops,
  134.  busdev->name, busdev);
  135. if (!busdev->busdev_region)
  136. return -ENOMEM;
  137. /* allocate resource region */
  138. res = request_mem_region(busdev->hpa, 0x100000, busdev->name);
  139. if (res) {
  140. res->flags = IORESOURCE_MEM;  /* do not mark it busy ! */
  141. }
  142. #if 0
  143. printk(KERN_WARNING "%s IRQ %d EIM 0x%x", busdev->name,
  144. busdev->parent_irq, busdev->eim);
  145. if (gsc_readl(busdev->hpa + OFFSET_IMR))
  146. printk("  IMR is non-zero! (0x%x)",
  147. gsc_readl(busdev->hpa + OFFSET_IMR));
  148. printk("n");
  149. #endif
  150. return 0;
  151. }
  152. extern struct parisc_driver lasi_driver;
  153. extern struct parisc_driver asp_driver;
  154. extern struct parisc_driver wax_driver;
  155. void __init gsc_init(void)
  156. {
  157. #ifdef CONFIG_GSC_LASI
  158. register_parisc_driver(&lasi_driver);
  159. register_parisc_driver(&asp_driver);
  160. #endif
  161. #ifdef CONFIG_GSC_WAX
  162. register_parisc_driver(&wax_driver);
  163. #endif
  164. }