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

Linux/Unix编程

开发平台:

Unix_Linux

  1. #include <linux/kernel.h>
  2. #include <linux/init.h>
  3. #include <linux/pci.h>
  4. #include <linux/slab.h>
  5. #include <asm/oplib.h>
  6. #include <asm/isa.h>
  7. struct isa_bridge *isa_chain;
  8. static void __init fatal_err(const char *reason)
  9. {
  10. prom_printf("ISA: fatal error, %s.n", reason);
  11. }
  12. static void __init report_dev(struct isa_device *isa_dev, int child)
  13. {
  14. if (child)
  15. printk(" (%s)", isa_dev->prom_name);
  16. else
  17. printk(" [%s", isa_dev->prom_name);
  18. }
  19. static void __init isa_dev_get_resource(struct isa_device *isa_dev)
  20. {
  21. struct linux_prom_registers regs[PROMREG_MAX];
  22. unsigned long base, len;
  23. int prop_len;
  24. prop_len = prom_getproperty(isa_dev->prom_node, "reg",
  25.     (char *) regs, sizeof(regs));
  26. if (prop_len <= 0)
  27. return;
  28. /* Only the first one is interesting. */
  29. len = regs[0].reg_size;
  30. base = (((unsigned long)regs[0].which_io << 32) |
  31. (unsigned long)regs[0].phys_addr);
  32. base += isa_dev->bus->parent->io_space.start;
  33. isa_dev->resource.start = base;
  34. isa_dev->resource.end   = (base + len - 1UL);
  35. isa_dev->resource.flags = IORESOURCE_IO;
  36. isa_dev->resource.name  = isa_dev->prom_name;
  37. request_resource(&isa_dev->bus->parent->io_space,
  38.  &isa_dev->resource);
  39. }
  40. /* I can't believe they didn't put a real INO in the isa device
  41.  * interrupts property.  The whole point of the OBP properties
  42.  * is to shield the kernel from IRQ routing details.
  43.  *
  44.  * The P1275 standard for ISA devices seems to also have been
  45.  * totally ignored.
  46.  */
  47. static struct {
  48. int obp_irq;
  49. int pci_ino;
  50. } grover_irq_table[] = {
  51. { 1, 0x00 }, /* dma, unknown ino at this point */
  52. { 2, 0x27 }, /* floppy */
  53. { 3, 0x22 }, /* parallel */
  54. { 4, 0x2b }, /* serial */
  55. { 5, 0x25 }, /* acpi power management */
  56. { 0, 0x00 } /* end of table */
  57. };
  58. static void __init isa_dev_get_irq(struct isa_device *isa_dev)
  59. {
  60. int irq_prop;
  61. irq_prop = prom_getintdefault(isa_dev->prom_node,
  62.       "interrupts", -1);
  63. if (irq_prop <= 0) {
  64. isa_dev->irq = PCI_IRQ_NONE;
  65. } else {
  66. int i;
  67. for (i = 0; grover_irq_table[i].obp_irq != 0; i++) {
  68. if (grover_irq_table[i].obp_irq == irq_prop) {
  69. struct pci_controller_info *pcic;
  70. struct pci_pbm_info *pbm;
  71. int ino = grover_irq_table[i].pci_ino;
  72. if (ino == 0) {
  73. isa_dev->irq = PCI_IRQ_NONE;
  74. } else {
  75. pbm = isa_dev->bus->parent;
  76. pcic = pbm->parent;
  77. isa_dev->irq = pcic->irq_build(pbm, NULL, ino);
  78. }
  79. }
  80. }
  81. }
  82. }
  83. static void __init isa_fill_children(struct isa_device *parent_isa_dev)
  84. {
  85. int node = prom_getchild(parent_isa_dev->prom_node);
  86. if (node == 0)
  87. return;
  88. printk(" ->");
  89. while (node != 0) {
  90. struct isa_device *isa_dev;
  91. int prop_len;
  92. isa_dev = kmalloc(sizeof(*isa_dev), GFP_KERNEL);
  93. if (!isa_dev) {
  94. fatal_err("cannot allocate child isa_dev");
  95. prom_halt();
  96. }
  97. memset(isa_dev, 0, sizeof(*isa_dev));
  98. /* Link it in to parent. */
  99. isa_dev->next = parent_isa_dev->child;
  100. parent_isa_dev->child = isa_dev;
  101. isa_dev->bus = parent_isa_dev->bus;
  102. isa_dev->prom_node = node;
  103. prop_len = prom_getproperty(node, "name",
  104.     (char *) isa_dev->prom_name,
  105.     sizeof(isa_dev->prom_name));
  106. if (prop_len <= 0) {
  107. fatal_err("cannot get child isa_dev OBP node name");
  108. prom_halt();
  109. }
  110. prop_len = prom_getproperty(node, "compatible",
  111.     (char *) isa_dev->compatible,
  112.     sizeof(isa_dev->compatible));
  113. /* Not having this is OK. */
  114. if (prop_len <= 0)
  115. isa_dev->compatible[0] = '';
  116. isa_dev_get_resource(isa_dev);
  117. isa_dev_get_irq(isa_dev);
  118. report_dev(isa_dev, 1);
  119. node = prom_getsibling(node);
  120. }
  121. }
  122. static void __init isa_fill_devices(struct isa_bridge *isa_br)
  123. {
  124. int node = prom_getchild(isa_br->prom_node);
  125. while (node != 0) {
  126. struct isa_device *isa_dev;
  127. int prop_len;
  128. isa_dev = kmalloc(sizeof(*isa_dev), GFP_KERNEL);
  129. if (!isa_dev) {
  130. fatal_err("cannot allocate isa_dev");
  131. prom_halt();
  132. }
  133. memset(isa_dev, 0, sizeof(*isa_dev));
  134. /* Link it in. */
  135. isa_dev->next = NULL;
  136. if (isa_br->devices == NULL) {
  137. isa_br->devices = isa_dev;
  138. } else {
  139. struct isa_device *tmp = isa_br->devices;
  140. while (tmp->next)
  141. tmp = tmp->next;
  142. tmp->next = isa_dev;
  143. }
  144. isa_dev->bus = isa_br;
  145. isa_dev->prom_node = node;
  146. prop_len = prom_getproperty(node, "name",
  147.     (char *) isa_dev->prom_name,
  148.     sizeof(isa_dev->prom_name));
  149. if (prop_len <= 0) {
  150. fatal_err("cannot get isa_dev OBP node name");
  151. prom_halt();
  152. }
  153. prop_len = prom_getproperty(node, "compatible",
  154.     (char *) isa_dev->compatible,
  155.     sizeof(isa_dev->compatible));
  156. /* Not having this is OK. */
  157. if (prop_len <= 0)
  158. isa_dev->compatible[0] = '';
  159. isa_dev_get_resource(isa_dev);
  160. isa_dev_get_irq(isa_dev);
  161. report_dev(isa_dev, 0);
  162. isa_fill_children(isa_dev);
  163. printk("]");
  164. node = prom_getsibling(node);
  165. }
  166. }
  167. void __init isa_init(void)
  168. {
  169. struct pci_dev *pdev;
  170. unsigned short vendor, device;
  171. int index = 0;
  172. vendor = PCI_VENDOR_ID_AL;
  173. device = PCI_DEVICE_ID_AL_M1533;
  174. pdev = NULL;
  175. while ((pdev = pci_find_device(vendor, device, pdev)) != NULL) {
  176. struct pcidev_cookie *pdev_cookie;
  177. struct pci_pbm_info *pbm;
  178. struct isa_bridge *isa_br;
  179. int prop_len;
  180. pdev_cookie = pdev->sysdata;
  181. if (!pdev_cookie) {
  182. printk("ISA: Warning, ISA bridge ignored due to "
  183.        "lack of OBP data.n");
  184. continue;
  185. }
  186. pbm = pdev_cookie->pbm;
  187. isa_br = kmalloc(sizeof(*isa_br), GFP_KERNEL);
  188. if (!isa_br) {
  189. fatal_err("cannot allocate isa_bridge");
  190. prom_halt();
  191. }
  192. memset(isa_br, 0, sizeof(*isa_br));
  193. /* Link it in. */
  194. isa_br->next = isa_chain;
  195. isa_chain = isa_br;
  196. isa_br->parent = pbm;
  197. isa_br->self = pdev;
  198. isa_br->index = index++;
  199. isa_br->prom_node = pdev_cookie->prom_node;
  200. strncpy(isa_br->prom_name, pdev_cookie->prom_name,
  201. sizeof(isa_br->prom_name));
  202. prop_len = prom_getproperty(isa_br->prom_node,
  203.     "ranges",
  204.     (char *) isa_br->isa_ranges,
  205.     sizeof(isa_br->isa_ranges));
  206. if (prop_len <= 0)
  207. isa_br->num_isa_ranges = 0;
  208. else
  209. isa_br->num_isa_ranges =
  210. (prop_len / sizeof(struct linux_prom_isa_ranges));
  211. printk("isa%d:", isa_br->index);
  212. isa_fill_devices(isa_br);
  213. printk("n");
  214. }
  215. }