tc.c 5.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193
  1. /*
  2. * TURBOchannel bus services.
  3. *
  4. * Copyright (c) Harald Koerfgen, 1998
  5. * Copyright (c) 2001, 2003, 2005, 2006 Maciej W. Rozycki
  6. * Copyright (c) 2005 James Simmons
  7. *
  8. * This file is subject to the terms and conditions of the GNU
  9. * General Public License. See the file "COPYING" in the main
  10. * directory of this archive for more details.
  11. */
  12. #include <linux/compiler.h>
  13. #include <linux/errno.h>
  14. #include <linux/init.h>
  15. #include <linux/ioport.h>
  16. #include <linux/kernel.h>
  17. #include <linux/list.h>
  18. #include <linux/module.h>
  19. #include <linux/string.h>
  20. #include <linux/tc.h>
  21. #include <linux/types.h>
  22. #include <asm/io.h>
  23. static struct tc_bus tc_bus = {
  24. .name = "TURBOchannel",
  25. };
  26. /*
  27. * Probing for TURBOchannel modules.
  28. */
  29. static void __init tc_bus_add_devices(struct tc_bus *tbus)
  30. {
  31. resource_size_t slotsize = tbus->info.slot_size << 20;
  32. resource_size_t extslotsize = tbus->ext_slot_size;
  33. resource_size_t slotaddr;
  34. resource_size_t extslotaddr;
  35. resource_size_t devsize;
  36. void __iomem *module;
  37. struct tc_dev *tdev;
  38. int i, slot, err;
  39. u8 pattern[4];
  40. long offset;
  41. for (slot = 0; slot < tbus->num_tcslots; slot++) {
  42. slotaddr = tbus->slot_base + slot * slotsize;
  43. extslotaddr = tbus->ext_slot_base + slot * extslotsize;
  44. module = ioremap_nocache(slotaddr, slotsize);
  45. BUG_ON(!module);
  46. offset = TC_OLDCARD;
  47. err = 0;
  48. err |= tc_preadb(pattern + 0, module + offset + TC_PATTERN0);
  49. err |= tc_preadb(pattern + 1, module + offset + TC_PATTERN1);
  50. err |= tc_preadb(pattern + 2, module + offset + TC_PATTERN2);
  51. err |= tc_preadb(pattern + 3, module + offset + TC_PATTERN3);
  52. if (err)
  53. goto out_err;
  54. if (pattern[0] != 0x55 || pattern[1] != 0x00 ||
  55. pattern[2] != 0xaa || pattern[3] != 0xff) {
  56. offset = TC_NEWCARD;
  57. err = 0;
  58. err |= tc_preadb(pattern + 0,
  59. module + offset + TC_PATTERN0);
  60. err |= tc_preadb(pattern + 1,
  61. module + offset + TC_PATTERN1);
  62. err |= tc_preadb(pattern + 2,
  63. module + offset + TC_PATTERN2);
  64. err |= tc_preadb(pattern + 3,
  65. module + offset + TC_PATTERN3);
  66. if (err)
  67. goto out_err;
  68. }
  69. if (pattern[0] != 0x55 || pattern[1] != 0x00 ||
  70. pattern[2] != 0xaa || pattern[3] != 0xff)
  71. goto out_err;
  72. /* Found a board, allocate it an entry in the list */
  73. tdev = kzalloc(sizeof(*tdev), GFP_KERNEL);
  74. if (!tdev) {
  75. printk(KERN_ERR "tc%x: unable to allocate tc_dev\n",
  76. slot);
  77. goto out_err;
  78. }
  79. sprintf(tdev->dev.bus_id, "tc%x", slot);
  80. tdev->bus = tbus;
  81. tdev->dev.parent = &tbus->dev;
  82. tdev->dev.bus = &tc_bus_type;
  83. tdev->slot = slot;
  84. for (i = 0; i < 8; i++) {
  85. tdev->firmware[i] =
  86. readb(module + offset + TC_FIRM_VER + 4 * i);
  87. tdev->vendor[i] =
  88. readb(module + offset + TC_VENDOR + 4 * i);
  89. tdev->name[i] =
  90. readb(module + offset + TC_MODULE + 4 * i);
  91. }
  92. tdev->firmware[8] = 0;
  93. tdev->vendor[8] = 0;
  94. tdev->name[8] = 0;
  95. pr_info("%s: %s %s %s\n", tdev->dev.bus_id, tdev->vendor,
  96. tdev->name, tdev->firmware);
  97. devsize = readb(module + offset + TC_SLOT_SIZE);
  98. devsize <<= 22;
  99. if (devsize <= slotsize) {
  100. tdev->resource.start = slotaddr;
  101. tdev->resource.end = slotaddr + devsize - 1;
  102. } else if (devsize <= extslotsize) {
  103. tdev->resource.start = extslotaddr;
  104. tdev->resource.end = extslotaddr + devsize - 1;
  105. } else {
  106. printk(KERN_ERR "%s: Cannot provide slot space "
  107. "(%dMiB required, up to %dMiB supported)\n",
  108. tdev->dev.bus_id, devsize >> 20,
  109. max(slotsize, extslotsize) >> 20);
  110. kfree(tdev);
  111. goto out_err;
  112. }
  113. tdev->resource.name = tdev->name;
  114. tdev->resource.flags = IORESOURCE_MEM;
  115. tc_device_get_irq(tdev);
  116. device_register(&tdev->dev);
  117. list_add_tail(&tdev->node, &tbus->devices);
  118. out_err:
  119. iounmap(module);
  120. }
  121. }
  122. /*
  123. * The main entry.
  124. */
  125. static int __init tc_init(void)
  126. {
  127. /* Initialize the TURBOchannel bus */
  128. if (tc_bus_get_info(&tc_bus))
  129. return 0;
  130. INIT_LIST_HEAD(&tc_bus.devices);
  131. strcpy(tc_bus.dev.bus_id, "tc");
  132. device_register(&tc_bus.dev);
  133. if (tc_bus.info.slot_size) {
  134. unsigned int tc_clock = tc_get_speed(&tc_bus) / 100000;
  135. pr_info("tc: TURBOchannel rev. %d at %d.%d MHz "
  136. "(with%s parity)\n", tc_bus.info.revision,
  137. tc_clock / 10, tc_clock % 10,
  138. tc_bus.info.parity ? "" : "out");
  139. tc_bus.resource[0].start = tc_bus.slot_base;
  140. tc_bus.resource[0].end = tc_bus.slot_base +
  141. (tc_bus.info.slot_size << 20) *
  142. tc_bus.num_tcslots - 1;
  143. tc_bus.resource[0].name = tc_bus.name;
  144. tc_bus.resource[0].flags = IORESOURCE_MEM;
  145. if (request_resource(&iomem_resource,
  146. &tc_bus.resource[0]) < 0) {
  147. printk(KERN_ERR "tc: Cannot reserve resource\n");
  148. return 0;
  149. }
  150. if (tc_bus.ext_slot_size) {
  151. tc_bus.resource[1].start = tc_bus.ext_slot_base;
  152. tc_bus.resource[1].end = tc_bus.ext_slot_base +
  153. tc_bus.ext_slot_size *
  154. tc_bus.num_tcslots - 1;
  155. tc_bus.resource[1].name = tc_bus.name;
  156. tc_bus.resource[1].flags = IORESOURCE_MEM;
  157. if (request_resource(&iomem_resource,
  158. &tc_bus.resource[1]) < 0) {
  159. printk(KERN_ERR
  160. "tc: Cannot reserve resource\n");
  161. release_resource(&tc_bus.resource[0]);
  162. return 0;
  163. }
  164. }
  165. tc_bus_add_devices(&tc_bus);
  166. }
  167. return 0;
  168. }
  169. subsys_initcall(tc_init);