lba_pci.c 48 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652
  1. /*
  2. **
  3. ** PCI Lower Bus Adapter (LBA) manager
  4. **
  5. ** (c) Copyright 1999,2000 Grant Grundler
  6. ** (c) Copyright 1999,2000 Hewlett-Packard Company
  7. **
  8. ** This program is free software; you can redistribute it and/or modify
  9. ** it under the terms of the GNU General Public License as published by
  10. ** the Free Software Foundation; either version 2 of the License, or
  11. ** (at your option) any later version.
  12. **
  13. **
  14. ** This module primarily provides access to PCI bus (config/IOport
  15. ** spaces) on platforms with an SBA/LBA chipset. A/B/C/J/L/N-class
  16. ** with 4 digit model numbers - eg C3000 (and A400...sigh).
  17. **
  18. ** LBA driver isn't as simple as the Dino driver because:
  19. ** (a) this chip has substantial bug fixes between revisions
  20. ** (Only one Dino bug has a software workaround :^( )
  21. ** (b) has more options which we don't (yet) support (DMA hints, OLARD)
  22. ** (c) IRQ support lives in the I/O SAPIC driver (not with PCI driver)
  23. ** (d) play nicely with both PAT and "Legacy" PA-RISC firmware (PDC).
  24. ** (dino only deals with "Legacy" PDC)
  25. **
  26. ** LBA driver passes the I/O SAPIC HPA to the I/O SAPIC driver.
  27. ** (I/O SAPIC is integratd in the LBA chip).
  28. **
  29. ** FIXME: Add support to SBA and LBA drivers for DMA hint sets
  30. ** FIXME: Add support for PCI card hot-plug (OLARD).
  31. */
  32. #include <linux/delay.h>
  33. #include <linux/types.h>
  34. #include <linux/kernel.h>
  35. #include <linux/spinlock.h>
  36. #include <linux/init.h> /* for __init */
  37. #include <linux/pci.h>
  38. #include <linux/ioport.h>
  39. #include <linux/slab.h>
  40. #include <asm/byteorder.h>
  41. #include <asm/pdc.h>
  42. #include <asm/pdcpat.h>
  43. #include <asm/page.h>
  44. #include <asm/ropes.h>
  45. #include <asm/hardware.h> /* for register_parisc_driver() stuff */
  46. #include <asm/parisc-device.h>
  47. #include <asm/io.h> /* read/write stuff */
  48. #undef DEBUG_LBA /* general stuff */
  49. #undef DEBUG_LBA_PORT /* debug I/O Port access */
  50. #undef DEBUG_LBA_CFG /* debug Config Space Access (ie PCI Bus walk) */
  51. #undef DEBUG_LBA_PAT /* debug PCI Resource Mgt code - PDC PAT only */
  52. #undef FBB_SUPPORT /* Fast Back-Back xfers - NOT READY YET */
  53. #ifdef DEBUG_LBA
  54. #define DBG(x...) printk(x)
  55. #else
  56. #define DBG(x...)
  57. #endif
  58. #ifdef DEBUG_LBA_PORT
  59. #define DBG_PORT(x...) printk(x)
  60. #else
  61. #define DBG_PORT(x...)
  62. #endif
  63. #ifdef DEBUG_LBA_CFG
  64. #define DBG_CFG(x...) printk(x)
  65. #else
  66. #define DBG_CFG(x...)
  67. #endif
  68. #ifdef DEBUG_LBA_PAT
  69. #define DBG_PAT(x...) printk(x)
  70. #else
  71. #define DBG_PAT(x...)
  72. #endif
  73. /*
  74. ** Config accessor functions only pass in the 8-bit bus number and not
  75. ** the 8-bit "PCI Segment" number. Each LBA will be assigned a PCI bus
  76. ** number based on what firmware wrote into the scratch register.
  77. **
  78. ** The "secondary" bus number is set to this before calling
  79. ** pci_register_ops(). If any PPB's are present, the scan will
  80. ** discover them and update the "secondary" and "subordinate"
  81. ** fields in the pci_bus structure.
  82. **
  83. ** Changes in the configuration *may* result in a different
  84. ** bus number for each LBA depending on what firmware does.
  85. */
  86. #define MODULE_NAME "LBA"
  87. /* non-postable I/O port space, densely packed */
  88. #define LBA_PORT_BASE (PCI_F_EXTEND | 0xfee00000UL)
  89. static void __iomem *astro_iop_base __read_mostly;
  90. static u32 lba_t32;
  91. /* lba flags */
  92. #define LBA_FLAG_SKIP_PROBE 0x10
  93. #define LBA_SKIP_PROBE(d) ((d)->flags & LBA_FLAG_SKIP_PROBE)
  94. /* Looks nice and keeps the compiler happy */
  95. #define LBA_DEV(d) ((struct lba_device *) (d))
  96. /*
  97. ** Only allow 8 subsidiary busses per LBA
  98. ** Problem is the PCI bus numbering is globally shared.
  99. */
  100. #define LBA_MAX_NUM_BUSES 8
  101. /************************************
  102. * LBA register read and write support
  103. *
  104. * BE WARNED: register writes are posted.
  105. * (ie follow writes which must reach HW with a read)
  106. */
  107. #define READ_U8(addr) __raw_readb(addr)
  108. #define READ_U16(addr) __raw_readw(addr)
  109. #define READ_U32(addr) __raw_readl(addr)
  110. #define WRITE_U8(value, addr) __raw_writeb(value, addr)
  111. #define WRITE_U16(value, addr) __raw_writew(value, addr)
  112. #define WRITE_U32(value, addr) __raw_writel(value, addr)
  113. #define READ_REG8(addr) readb(addr)
  114. #define READ_REG16(addr) readw(addr)
  115. #define READ_REG32(addr) readl(addr)
  116. #define READ_REG64(addr) readq(addr)
  117. #define WRITE_REG8(value, addr) writeb(value, addr)
  118. #define WRITE_REG16(value, addr) writew(value, addr)
  119. #define WRITE_REG32(value, addr) writel(value, addr)
  120. #define LBA_CFG_TOK(bus,dfn) ((u32) ((bus)<<16 | (dfn)<<8))
  121. #define LBA_CFG_BUS(tok) ((u8) ((tok)>>16))
  122. #define LBA_CFG_DEV(tok) ((u8) ((tok)>>11) & 0x1f)
  123. #define LBA_CFG_FUNC(tok) ((u8) ((tok)>>8 ) & 0x7)
  124. /*
  125. ** Extract LBA (Rope) number from HPA
  126. ** REVISIT: 16 ropes for Stretch/Ike?
  127. */
  128. #define ROPES_PER_IOC 8
  129. #define LBA_NUM(x) ((((unsigned long) x) >> 13) & (ROPES_PER_IOC-1))
  130. static void
  131. lba_dump_res(struct resource *r, int d)
  132. {
  133. int i;
  134. if (NULL == r)
  135. return;
  136. printk(KERN_DEBUG "(%p)", r->parent);
  137. for (i = d; i ; --i) printk(" ");
  138. printk(KERN_DEBUG "%p [%lx,%lx]/%lx\n", r,
  139. (long)r->start, (long)r->end, r->flags);
  140. lba_dump_res(r->child, d+2);
  141. lba_dump_res(r->sibling, d);
  142. }
  143. /*
  144. ** LBA rev 2.0, 2.1, 2.2, and 3.0 bus walks require a complex
  145. ** workaround for cfg cycles:
  146. ** -- preserve LBA state
  147. ** -- prevent any DMA from occurring
  148. ** -- turn on smart mode
  149. ** -- probe with config writes before doing config reads
  150. ** -- check ERROR_STATUS
  151. ** -- clear ERROR_STATUS
  152. ** -- restore LBA state
  153. **
  154. ** The workaround is only used for device discovery.
  155. */
  156. static int lba_device_present(u8 bus, u8 dfn, struct lba_device *d)
  157. {
  158. u8 first_bus = d->hba.hba_bus->busn_res.start;
  159. u8 last_sub_bus = d->hba.hba_bus->busn_res.end;
  160. if ((bus < first_bus) ||
  161. (bus > last_sub_bus) ||
  162. ((bus - first_bus) >= LBA_MAX_NUM_BUSES)) {
  163. return 0;
  164. }
  165. return 1;
  166. }
  167. #define LBA_CFG_SETUP(d, tok) { \
  168. /* Save contents of error config register. */ \
  169. error_config = READ_REG32(d->hba.base_addr + LBA_ERROR_CONFIG); \
  170. \
  171. /* Save contents of status control register. */ \
  172. status_control = READ_REG32(d->hba.base_addr + LBA_STAT_CTL); \
  173. \
  174. /* For LBA rev 2.0, 2.1, 2.2, and 3.0, we must disable DMA \
  175. ** arbitration for full bus walks. \
  176. */ \
  177. /* Save contents of arb mask register. */ \
  178. arb_mask = READ_REG32(d->hba.base_addr + LBA_ARB_MASK); \
  179. \
  180. /* \
  181. * Turn off all device arbitration bits (i.e. everything \
  182. * except arbitration enable bit). \
  183. */ \
  184. WRITE_REG32(0x1, d->hba.base_addr + LBA_ARB_MASK); \
  185. \
  186. /* \
  187. * Set the smart mode bit so that master aborts don't cause \
  188. * LBA to go into PCI fatal mode (required). \
  189. */ \
  190. WRITE_REG32(error_config | LBA_SMART_MODE, d->hba.base_addr + LBA_ERROR_CONFIG); \
  191. }
  192. #define LBA_CFG_PROBE(d, tok) { \
  193. /* \
  194. * Setup Vendor ID write and read back the address register \
  195. * to make sure that LBA is the bus master. \
  196. */ \
  197. WRITE_REG32(tok | PCI_VENDOR_ID, (d)->hba.base_addr + LBA_PCI_CFG_ADDR);\
  198. /* \
  199. * Read address register to ensure that LBA is the bus master, \
  200. * which implies that DMA traffic has stopped when DMA arb is off. \
  201. */ \
  202. lba_t32 = READ_REG32((d)->hba.base_addr + LBA_PCI_CFG_ADDR); \
  203. /* \
  204. * Generate a cfg write cycle (will have no affect on \
  205. * Vendor ID register since read-only). \
  206. */ \
  207. WRITE_REG32(~0, (d)->hba.base_addr + LBA_PCI_CFG_DATA); \
  208. /* \
  209. * Make sure write has completed before proceeding further, \
  210. * i.e. before setting clear enable. \
  211. */ \
  212. lba_t32 = READ_REG32((d)->hba.base_addr + LBA_PCI_CFG_ADDR); \
  213. }
  214. /*
  215. * HPREVISIT:
  216. * -- Can't tell if config cycle got the error.
  217. *
  218. * OV bit is broken until rev 4.0, so can't use OV bit and
  219. * LBA_ERROR_LOG_ADDR to tell if error belongs to config cycle.
  220. *
  221. * As of rev 4.0, no longer need the error check.
  222. *
  223. * -- Even if we could tell, we still want to return -1
  224. * for **ANY** error (not just master abort).
  225. *
  226. * -- Only clear non-fatal errors (we don't want to bring
  227. * LBA out of pci-fatal mode).
  228. *
  229. * Actually, there is still a race in which
  230. * we could be clearing a fatal error. We will
  231. * live with this during our initial bus walk
  232. * until rev 4.0 (no driver activity during
  233. * initial bus walk). The initial bus walk
  234. * has race conditions concerning the use of
  235. * smart mode as well.
  236. */
  237. #define LBA_MASTER_ABORT_ERROR 0xc
  238. #define LBA_FATAL_ERROR 0x10
  239. #define LBA_CFG_MASTER_ABORT_CHECK(d, base, tok, error) { \
  240. u32 error_status = 0; \
  241. /* \
  242. * Set clear enable (CE) bit. Unset by HW when new \
  243. * errors are logged -- LBA HW ERS section 14.3.3). \
  244. */ \
  245. WRITE_REG32(status_control | CLEAR_ERRLOG_ENABLE, base + LBA_STAT_CTL); \
  246. error_status = READ_REG32(base + LBA_ERROR_STATUS); \
  247. if ((error_status & 0x1f) != 0) { \
  248. /* \
  249. * Fail the config read request. \
  250. */ \
  251. error = 1; \
  252. if ((error_status & LBA_FATAL_ERROR) == 0) { \
  253. /* \
  254. * Clear error status (if fatal bit not set) by setting \
  255. * clear error log bit (CL). \
  256. */ \
  257. WRITE_REG32(status_control | CLEAR_ERRLOG, base + LBA_STAT_CTL); \
  258. } \
  259. } \
  260. }
  261. #define LBA_CFG_TR4_ADDR_SETUP(d, addr) \
  262. WRITE_REG32(((addr) & ~3), (d)->hba.base_addr + LBA_PCI_CFG_ADDR);
  263. #define LBA_CFG_ADDR_SETUP(d, addr) { \
  264. WRITE_REG32(((addr) & ~3), (d)->hba.base_addr + LBA_PCI_CFG_ADDR); \
  265. /* \
  266. * Read address register to ensure that LBA is the bus master, \
  267. * which implies that DMA traffic has stopped when DMA arb is off. \
  268. */ \
  269. lba_t32 = READ_REG32((d)->hba.base_addr + LBA_PCI_CFG_ADDR); \
  270. }
  271. #define LBA_CFG_RESTORE(d, base) { \
  272. /* \
  273. * Restore status control register (turn off clear enable). \
  274. */ \
  275. WRITE_REG32(status_control, base + LBA_STAT_CTL); \
  276. /* \
  277. * Restore error config register (turn off smart mode). \
  278. */ \
  279. WRITE_REG32(error_config, base + LBA_ERROR_CONFIG); \
  280. /* \
  281. * Restore arb mask register (reenables DMA arbitration). \
  282. */ \
  283. WRITE_REG32(arb_mask, base + LBA_ARB_MASK); \
  284. }
  285. static unsigned int
  286. lba_rd_cfg(struct lba_device *d, u32 tok, u8 reg, u32 size)
  287. {
  288. u32 data = ~0U;
  289. int error = 0;
  290. u32 arb_mask = 0; /* used by LBA_CFG_SETUP/RESTORE */
  291. u32 error_config = 0; /* used by LBA_CFG_SETUP/RESTORE */
  292. u32 status_control = 0; /* used by LBA_CFG_SETUP/RESTORE */
  293. LBA_CFG_SETUP(d, tok);
  294. LBA_CFG_PROBE(d, tok);
  295. LBA_CFG_MASTER_ABORT_CHECK(d, d->hba.base_addr, tok, error);
  296. if (!error) {
  297. void __iomem *data_reg = d->hba.base_addr + LBA_PCI_CFG_DATA;
  298. LBA_CFG_ADDR_SETUP(d, tok | reg);
  299. switch (size) {
  300. case 1: data = (u32) READ_REG8(data_reg + (reg & 3)); break;
  301. case 2: data = (u32) READ_REG16(data_reg+ (reg & 2)); break;
  302. case 4: data = READ_REG32(data_reg); break;
  303. }
  304. }
  305. LBA_CFG_RESTORE(d, d->hba.base_addr);
  306. return(data);
  307. }
  308. static int elroy_cfg_read(struct pci_bus *bus, unsigned int devfn, int pos, int size, u32 *data)
  309. {
  310. struct lba_device *d = LBA_DEV(parisc_walk_tree(bus->bridge));
  311. u32 local_bus = (bus->parent == NULL) ? 0 : bus->busn_res.start;
  312. u32 tok = LBA_CFG_TOK(local_bus, devfn);
  313. void __iomem *data_reg = d->hba.base_addr + LBA_PCI_CFG_DATA;
  314. if ((pos > 255) || (devfn > 255))
  315. return -EINVAL;
  316. /* FIXME: B2K/C3600 workaround is always use old method... */
  317. /* if (!LBA_SKIP_PROBE(d)) */ {
  318. /* original - Generate config cycle on broken elroy
  319. with risk we will miss PCI bus errors. */
  320. *data = lba_rd_cfg(d, tok, pos, size);
  321. DBG_CFG("%s(%x+%2x) -> 0x%x (a)\n", __func__, tok, pos, *data);
  322. return 0;
  323. }
  324. if (LBA_SKIP_PROBE(d) && !lba_device_present(bus->busn_res.start, devfn, d)) {
  325. DBG_CFG("%s(%x+%2x) -> -1 (b)\n", __func__, tok, pos);
  326. /* either don't want to look or know device isn't present. */
  327. *data = ~0U;
  328. return(0);
  329. }
  330. /* Basic Algorithm
  331. ** Should only get here on fully working LBA rev.
  332. ** This is how simple the code should have been.
  333. */
  334. LBA_CFG_ADDR_SETUP(d, tok | pos);
  335. switch(size) {
  336. case 1: *data = READ_REG8 (data_reg + (pos & 3)); break;
  337. case 2: *data = READ_REG16(data_reg + (pos & 2)); break;
  338. case 4: *data = READ_REG32(data_reg); break;
  339. }
  340. DBG_CFG("%s(%x+%2x) -> 0x%x (c)\n", __func__, tok, pos, *data);
  341. return 0;
  342. }
  343. static void
  344. lba_wr_cfg(struct lba_device *d, u32 tok, u8 reg, u32 data, u32 size)
  345. {
  346. int error = 0;
  347. u32 arb_mask = 0;
  348. u32 error_config = 0;
  349. u32 status_control = 0;
  350. void __iomem *data_reg = d->hba.base_addr + LBA_PCI_CFG_DATA;
  351. LBA_CFG_SETUP(d, tok);
  352. LBA_CFG_ADDR_SETUP(d, tok | reg);
  353. switch (size) {
  354. case 1: WRITE_REG8 (data, data_reg + (reg & 3)); break;
  355. case 2: WRITE_REG16(data, data_reg + (reg & 2)); break;
  356. case 4: WRITE_REG32(data, data_reg); break;
  357. }
  358. LBA_CFG_MASTER_ABORT_CHECK(d, d->hba.base_addr, tok, error);
  359. LBA_CFG_RESTORE(d, d->hba.base_addr);
  360. }
  361. /*
  362. * LBA 4.0 config write code implements non-postable semantics
  363. * by doing a read of CONFIG ADDR after the write.
  364. */
  365. static int elroy_cfg_write(struct pci_bus *bus, unsigned int devfn, int pos, int size, u32 data)
  366. {
  367. struct lba_device *d = LBA_DEV(parisc_walk_tree(bus->bridge));
  368. u32 local_bus = (bus->parent == NULL) ? 0 : bus->busn_res.start;
  369. u32 tok = LBA_CFG_TOK(local_bus,devfn);
  370. if ((pos > 255) || (devfn > 255))
  371. return -EINVAL;
  372. if (!LBA_SKIP_PROBE(d)) {
  373. /* Original Workaround */
  374. lba_wr_cfg(d, tok, pos, (u32) data, size);
  375. DBG_CFG("%s(%x+%2x) = 0x%x (a)\n", __func__, tok, pos,data);
  376. return 0;
  377. }
  378. if (LBA_SKIP_PROBE(d) && (!lba_device_present(bus->busn_res.start, devfn, d))) {
  379. DBG_CFG("%s(%x+%2x) = 0x%x (b)\n", __func__, tok, pos,data);
  380. return 1; /* New Workaround */
  381. }
  382. DBG_CFG("%s(%x+%2x) = 0x%x (c)\n", __func__, tok, pos, data);
  383. /* Basic Algorithm */
  384. LBA_CFG_ADDR_SETUP(d, tok | pos);
  385. switch(size) {
  386. case 1: WRITE_REG8 (data, d->hba.base_addr + LBA_PCI_CFG_DATA + (pos & 3));
  387. break;
  388. case 2: WRITE_REG16(data, d->hba.base_addr + LBA_PCI_CFG_DATA + (pos & 2));
  389. break;
  390. case 4: WRITE_REG32(data, d->hba.base_addr + LBA_PCI_CFG_DATA);
  391. break;
  392. }
  393. /* flush posted write */
  394. lba_t32 = READ_REG32(d->hba.base_addr + LBA_PCI_CFG_ADDR);
  395. return 0;
  396. }
  397. static struct pci_ops elroy_cfg_ops = {
  398. .read = elroy_cfg_read,
  399. .write = elroy_cfg_write,
  400. };
  401. /*
  402. * The mercury_cfg_ops are slightly misnamed; they're also used for Elroy
  403. * TR4.0 as no additional bugs were found in this areea between Elroy and
  404. * Mercury
  405. */
  406. static int mercury_cfg_read(struct pci_bus *bus, unsigned int devfn, int pos, int size, u32 *data)
  407. {
  408. struct lba_device *d = LBA_DEV(parisc_walk_tree(bus->bridge));
  409. u32 local_bus = (bus->parent == NULL) ? 0 : bus->busn_res.start;
  410. u32 tok = LBA_CFG_TOK(local_bus, devfn);
  411. void __iomem *data_reg = d->hba.base_addr + LBA_PCI_CFG_DATA;
  412. if ((pos > 255) || (devfn > 255))
  413. return -EINVAL;
  414. LBA_CFG_TR4_ADDR_SETUP(d, tok | pos);
  415. switch(size) {
  416. case 1:
  417. *data = READ_REG8(data_reg + (pos & 3));
  418. break;
  419. case 2:
  420. *data = READ_REG16(data_reg + (pos & 2));
  421. break;
  422. case 4:
  423. *data = READ_REG32(data_reg); break;
  424. break;
  425. }
  426. DBG_CFG("mercury_cfg_read(%x+%2x) -> 0x%x\n", tok, pos, *data);
  427. return 0;
  428. }
  429. /*
  430. * LBA 4.0 config write code implements non-postable semantics
  431. * by doing a read of CONFIG ADDR after the write.
  432. */
  433. static int mercury_cfg_write(struct pci_bus *bus, unsigned int devfn, int pos, int size, u32 data)
  434. {
  435. struct lba_device *d = LBA_DEV(parisc_walk_tree(bus->bridge));
  436. void __iomem *data_reg = d->hba.base_addr + LBA_PCI_CFG_DATA;
  437. u32 local_bus = (bus->parent == NULL) ? 0 : bus->busn_res.start;
  438. u32 tok = LBA_CFG_TOK(local_bus,devfn);
  439. if ((pos > 255) || (devfn > 255))
  440. return -EINVAL;
  441. DBG_CFG("%s(%x+%2x) <- 0x%x (c)\n", __func__, tok, pos, data);
  442. LBA_CFG_TR4_ADDR_SETUP(d, tok | pos);
  443. switch(size) {
  444. case 1:
  445. WRITE_REG8 (data, data_reg + (pos & 3));
  446. break;
  447. case 2:
  448. WRITE_REG16(data, data_reg + (pos & 2));
  449. break;
  450. case 4:
  451. WRITE_REG32(data, data_reg);
  452. break;
  453. }
  454. /* flush posted write */
  455. lba_t32 = READ_U32(d->hba.base_addr + LBA_PCI_CFG_ADDR);
  456. return 0;
  457. }
  458. static struct pci_ops mercury_cfg_ops = {
  459. .read = mercury_cfg_read,
  460. .write = mercury_cfg_write,
  461. };
  462. static void
  463. lba_bios_init(void)
  464. {
  465. DBG(MODULE_NAME ": lba_bios_init\n");
  466. }
  467. #ifdef CONFIG_64BIT
  468. /*
  469. * truncate_pat_collision: Deal with overlaps or outright collisions
  470. * between PAT PDC reported ranges.
  471. *
  472. * Broken PA8800 firmware will report lmmio range that
  473. * overlaps with CPU HPA. Just truncate the lmmio range.
  474. *
  475. * BEWARE: conflicts with this lmmio range may be an
  476. * elmmio range which is pointing down another rope.
  477. *
  478. * FIXME: only deals with one collision per range...theoretically we
  479. * could have several. Supporting more than one collision will get messy.
  480. */
  481. static unsigned long
  482. truncate_pat_collision(struct resource *root, struct resource *new)
  483. {
  484. unsigned long start = new->start;
  485. unsigned long end = new->end;
  486. struct resource *tmp = root->child;
  487. if (end <= start || start < root->start || !tmp)
  488. return 0;
  489. /* find first overlap */
  490. while (tmp && tmp->end < start)
  491. tmp = tmp->sibling;
  492. /* no entries overlap */
  493. if (!tmp) return 0;
  494. /* found one that starts behind the new one
  495. ** Don't need to do anything.
  496. */
  497. if (tmp->start >= end) return 0;
  498. if (tmp->start <= start) {
  499. /* "front" of new one overlaps */
  500. new->start = tmp->end + 1;
  501. if (tmp->end >= end) {
  502. /* AACCKK! totally overlaps! drop this range. */
  503. return 1;
  504. }
  505. }
  506. if (tmp->end < end ) {
  507. /* "end" of new one overlaps */
  508. new->end = tmp->start - 1;
  509. }
  510. printk(KERN_WARNING "LBA: Truncating lmmio_space [%lx/%lx] "
  511. "to [%lx,%lx]\n",
  512. start, end,
  513. (long)new->start, (long)new->end );
  514. return 0; /* truncation successful */
  515. }
  516. /*
  517. * extend_lmmio_len: extend lmmio range to maximum length
  518. *
  519. * This is needed at least on C8000 systems to get the ATI FireGL card
  520. * working. On other systems we will currently not extend the lmmio space.
  521. */
  522. static unsigned long
  523. extend_lmmio_len(unsigned long start, unsigned long end, unsigned long lba_len)
  524. {
  525. struct resource *tmp;
  526. pr_debug("LMMIO mismatch: PAT length = 0x%lx, MASK register = 0x%lx\n",
  527. end - start, lba_len);
  528. lba_len = min(lba_len+1, 256UL*1024*1024); /* limit to 256 MB */
  529. pr_debug("LBA: lmmio_space [0x%lx-0x%lx] - original\n", start, end);
  530. if (boot_cpu_data.cpu_type < mako) {
  531. pr_info("LBA: Not a C8000 system - not extending LMMIO range.\n");
  532. return end;
  533. }
  534. end += lba_len;
  535. if (end < start) /* fix overflow */
  536. end = -1ULL;
  537. pr_debug("LBA: lmmio_space [0x%lx-0x%lx] - current\n", start, end);
  538. /* first overlap */
  539. for (tmp = iomem_resource.child; tmp; tmp = tmp->sibling) {
  540. pr_debug("LBA: testing %pR\n", tmp);
  541. if (tmp->start == start)
  542. continue; /* ignore ourself */
  543. if (tmp->end < start)
  544. continue;
  545. if (tmp->start > end)
  546. continue;
  547. if (end >= tmp->start)
  548. end = tmp->start - 1;
  549. }
  550. pr_info("LBA: lmmio_space [0x%lx-0x%lx] - new\n", start, end);
  551. /* return new end */
  552. return end;
  553. }
  554. #else
  555. #define truncate_pat_collision(r,n) (0)
  556. #endif
  557. /*
  558. ** The algorithm is generic code.
  559. ** But it needs to access local data structures to get the IRQ base.
  560. ** Could make this a "pci_fixup_irq(bus, region)" but not sure
  561. ** it's worth it.
  562. **
  563. ** Called by do_pci_scan_bus() immediately after each PCI bus is walked.
  564. ** Resources aren't allocated until recursive buswalk below HBA is completed.
  565. */
  566. static void
  567. lba_fixup_bus(struct pci_bus *bus)
  568. {
  569. struct pci_dev *dev;
  570. #ifdef FBB_SUPPORT
  571. u16 status;
  572. #endif
  573. struct lba_device *ldev = LBA_DEV(parisc_walk_tree(bus->bridge));
  574. DBG("lba_fixup_bus(0x%p) bus %d platform_data 0x%p\n",
  575. bus, (int)bus->busn_res.start, bus->bridge->platform_data);
  576. /*
  577. ** Properly Setup MMIO resources for this bus.
  578. ** pci_alloc_primary_bus() mangles this.
  579. */
  580. if (bus->parent) {
  581. int i;
  582. /* PCI-PCI Bridge */
  583. pci_read_bridge_bases(bus);
  584. for (i = PCI_BRIDGE_RESOURCES; i < PCI_NUM_RESOURCES; i++) {
  585. pci_claim_resource(bus->self, i);
  586. }
  587. } else {
  588. /* Host-PCI Bridge */
  589. int err;
  590. DBG("lba_fixup_bus() %s [%lx/%lx]/%lx\n",
  591. ldev->hba.io_space.name,
  592. ldev->hba.io_space.start, ldev->hba.io_space.end,
  593. ldev->hba.io_space.flags);
  594. DBG("lba_fixup_bus() %s [%lx/%lx]/%lx\n",
  595. ldev->hba.lmmio_space.name,
  596. ldev->hba.lmmio_space.start, ldev->hba.lmmio_space.end,
  597. ldev->hba.lmmio_space.flags);
  598. err = request_resource(&ioport_resource, &(ldev->hba.io_space));
  599. if (err < 0) {
  600. lba_dump_res(&ioport_resource, 2);
  601. BUG();
  602. }
  603. if (ldev->hba.elmmio_space.flags) {
  604. err = request_resource(&iomem_resource,
  605. &(ldev->hba.elmmio_space));
  606. if (err < 0) {
  607. printk("FAILED: lba_fixup_bus() request for "
  608. "elmmio_space [%lx/%lx]\n",
  609. (long)ldev->hba.elmmio_space.start,
  610. (long)ldev->hba.elmmio_space.end);
  611. /* lba_dump_res(&iomem_resource, 2); */
  612. /* BUG(); */
  613. }
  614. }
  615. if (ldev->hba.lmmio_space.flags) {
  616. err = request_resource(&iomem_resource, &(ldev->hba.lmmio_space));
  617. if (err < 0) {
  618. printk(KERN_ERR "FAILED: lba_fixup_bus() request for "
  619. "lmmio_space [%lx/%lx]\n",
  620. (long)ldev->hba.lmmio_space.start,
  621. (long)ldev->hba.lmmio_space.end);
  622. }
  623. }
  624. #ifdef CONFIG_64BIT
  625. /* GMMIO is distributed range. Every LBA/Rope gets part it. */
  626. if (ldev->hba.gmmio_space.flags) {
  627. err = request_resource(&iomem_resource, &(ldev->hba.gmmio_space));
  628. if (err < 0) {
  629. printk("FAILED: lba_fixup_bus() request for "
  630. "gmmio_space [%lx/%lx]\n",
  631. (long)ldev->hba.gmmio_space.start,
  632. (long)ldev->hba.gmmio_space.end);
  633. lba_dump_res(&iomem_resource, 2);
  634. BUG();
  635. }
  636. }
  637. #endif
  638. }
  639. list_for_each_entry(dev, &bus->devices, bus_list) {
  640. int i;
  641. DBG("lba_fixup_bus() %s\n", pci_name(dev));
  642. /* Virtualize Device/Bridge Resources. */
  643. for (i = 0; i < PCI_BRIDGE_RESOURCES; i++) {
  644. struct resource *res = &dev->resource[i];
  645. /* If resource not allocated - skip it */
  646. if (!res->start)
  647. continue;
  648. /*
  649. ** FIXME: this will result in whinging for devices
  650. ** that share expansion ROMs (think quad tulip), but
  651. ** isn't harmful.
  652. */
  653. pci_claim_resource(dev, i);
  654. }
  655. #ifdef FBB_SUPPORT
  656. /*
  657. ** If one device does not support FBB transfers,
  658. ** No one on the bus can be allowed to use them.
  659. */
  660. (void) pci_read_config_word(dev, PCI_STATUS, &status);
  661. bus->bridge_ctl &= ~(status & PCI_STATUS_FAST_BACK);
  662. #endif
  663. /*
  664. ** P2PB's have no IRQs. ignore them.
  665. */
  666. if ((dev->class >> 8) == PCI_CLASS_BRIDGE_PCI)
  667. continue;
  668. /* Adjust INTERRUPT_LINE for this dev */
  669. iosapic_fixup_irq(ldev->iosapic_obj, dev);
  670. }
  671. #ifdef FBB_SUPPORT
  672. /* FIXME/REVISIT - finish figuring out to set FBB on both
  673. ** pci_setup_bridge() clobbers PCI_BRIDGE_CONTROL.
  674. ** Can't fixup here anyway....garr...
  675. */
  676. if (fbb_enable) {
  677. if (bus->parent) {
  678. u8 control;
  679. /* enable on PPB */
  680. (void) pci_read_config_byte(bus->self, PCI_BRIDGE_CONTROL, &control);
  681. (void) pci_write_config_byte(bus->self, PCI_BRIDGE_CONTROL, control | PCI_STATUS_FAST_BACK);
  682. } else {
  683. /* enable on LBA */
  684. }
  685. fbb_enable = PCI_COMMAND_FAST_BACK;
  686. }
  687. /* Lastly enable FBB/PERR/SERR on all devices too */
  688. list_for_each_entry(dev, &bus->devices, bus_list) {
  689. (void) pci_read_config_word(dev, PCI_COMMAND, &status);
  690. status |= PCI_COMMAND_PARITY | PCI_COMMAND_SERR | fbb_enable;
  691. (void) pci_write_config_word(dev, PCI_COMMAND, status);
  692. }
  693. #endif
  694. }
  695. static struct pci_bios_ops lba_bios_ops = {
  696. .init = lba_bios_init,
  697. .fixup_bus = lba_fixup_bus,
  698. };
  699. /*******************************************************
  700. **
  701. ** LBA Sprockets "I/O Port" Space Accessor Functions
  702. **
  703. ** This set of accessor functions is intended for use with
  704. ** "legacy firmware" (ie Sprockets on Allegro/Forte boxes).
  705. **
  706. ** Many PCI devices don't require use of I/O port space (eg Tulip,
  707. ** NCR720) since they export the same registers to both MMIO and
  708. ** I/O port space. In general I/O port space is slower than
  709. ** MMIO since drivers are designed so PIO writes can be posted.
  710. **
  711. ********************************************************/
  712. #define LBA_PORT_IN(size, mask) \
  713. static u##size lba_astro_in##size (struct pci_hba_data *d, u16 addr) \
  714. { \
  715. u##size t; \
  716. t = READ_REG##size(astro_iop_base + addr); \
  717. DBG_PORT(" 0x%x\n", t); \
  718. return (t); \
  719. }
  720. LBA_PORT_IN( 8, 3)
  721. LBA_PORT_IN(16, 2)
  722. LBA_PORT_IN(32, 0)
  723. /*
  724. ** BUG X4107: Ordering broken - DMA RD return can bypass PIO WR
  725. **
  726. ** Fixed in Elroy 2.2. The READ_U32(..., LBA_FUNC_ID) below is
  727. ** guarantee non-postable completion semantics - not avoid X4107.
  728. ** The READ_U32 only guarantees the write data gets to elroy but
  729. ** out to the PCI bus. We can't read stuff from I/O port space
  730. ** since we don't know what has side-effects. Attempting to read
  731. ** from configuration space would be suicidal given the number of
  732. ** bugs in that elroy functionality.
  733. **
  734. ** Description:
  735. ** DMA read results can improperly pass PIO writes (X4107). The
  736. ** result of this bug is that if a processor modifies a location in
  737. ** memory after having issued PIO writes, the PIO writes are not
  738. ** guaranteed to be completed before a PCI device is allowed to see
  739. ** the modified data in a DMA read.
  740. **
  741. ** Note that IKE bug X3719 in TR1 IKEs will result in the same
  742. ** symptom.
  743. **
  744. ** Workaround:
  745. ** The workaround for this bug is to always follow a PIO write with
  746. ** a PIO read to the same bus before starting DMA on that PCI bus.
  747. **
  748. */
  749. #define LBA_PORT_OUT(size, mask) \
  750. static void lba_astro_out##size (struct pci_hba_data *d, u16 addr, u##size val) \
  751. { \
  752. DBG_PORT("%s(0x%p, 0x%x, 0x%x)\n", __func__, d, addr, val); \
  753. WRITE_REG##size(val, astro_iop_base + addr); \
  754. if (LBA_DEV(d)->hw_rev < 3) \
  755. lba_t32 = READ_U32(d->base_addr + LBA_FUNC_ID); \
  756. }
  757. LBA_PORT_OUT( 8, 3)
  758. LBA_PORT_OUT(16, 2)
  759. LBA_PORT_OUT(32, 0)
  760. static struct pci_port_ops lba_astro_port_ops = {
  761. .inb = lba_astro_in8,
  762. .inw = lba_astro_in16,
  763. .inl = lba_astro_in32,
  764. .outb = lba_astro_out8,
  765. .outw = lba_astro_out16,
  766. .outl = lba_astro_out32
  767. };
  768. #ifdef CONFIG_64BIT
  769. #define PIOP_TO_GMMIO(lba, addr) \
  770. ((lba)->iop_base + (((addr)&0xFFFC)<<10) + ((addr)&3))
  771. /*******************************************************
  772. **
  773. ** LBA PAT "I/O Port" Space Accessor Functions
  774. **
  775. ** This set of accessor functions is intended for use with
  776. ** "PAT PDC" firmware (ie Prelude/Rhapsody/Piranha boxes).
  777. **
  778. ** This uses the PIOP space located in the first 64MB of GMMIO.
  779. ** Each rope gets a full 64*KB* (ie 4 bytes per page) this way.
  780. ** bits 1:0 stay the same. bits 15:2 become 25:12.
  781. ** Then add the base and we can generate an I/O Port cycle.
  782. ********************************************************/
  783. #undef LBA_PORT_IN
  784. #define LBA_PORT_IN(size, mask) \
  785. static u##size lba_pat_in##size (struct pci_hba_data *l, u16 addr) \
  786. { \
  787. u##size t; \
  788. DBG_PORT("%s(0x%p, 0x%x) ->", __func__, l, addr); \
  789. t = READ_REG##size(PIOP_TO_GMMIO(LBA_DEV(l), addr)); \
  790. DBG_PORT(" 0x%x\n", t); \
  791. return (t); \
  792. }
  793. LBA_PORT_IN( 8, 3)
  794. LBA_PORT_IN(16, 2)
  795. LBA_PORT_IN(32, 0)
  796. #undef LBA_PORT_OUT
  797. #define LBA_PORT_OUT(size, mask) \
  798. static void lba_pat_out##size (struct pci_hba_data *l, u16 addr, u##size val) \
  799. { \
  800. void __iomem *where = PIOP_TO_GMMIO(LBA_DEV(l), addr); \
  801. DBG_PORT("%s(0x%p, 0x%x, 0x%x)\n", __func__, l, addr, val); \
  802. WRITE_REG##size(val, where); \
  803. /* flush the I/O down to the elroy at least */ \
  804. lba_t32 = READ_U32(l->base_addr + LBA_FUNC_ID); \
  805. }
  806. LBA_PORT_OUT( 8, 3)
  807. LBA_PORT_OUT(16, 2)
  808. LBA_PORT_OUT(32, 0)
  809. static struct pci_port_ops lba_pat_port_ops = {
  810. .inb = lba_pat_in8,
  811. .inw = lba_pat_in16,
  812. .inl = lba_pat_in32,
  813. .outb = lba_pat_out8,
  814. .outw = lba_pat_out16,
  815. .outl = lba_pat_out32
  816. };
  817. /*
  818. ** make range information from PDC available to PCI subsystem.
  819. ** We make the PDC call here in order to get the PCI bus range
  820. ** numbers. The rest will get forwarded in pcibios_fixup_bus().
  821. ** We don't have a struct pci_bus assigned to us yet.
  822. */
  823. static void
  824. lba_pat_resources(struct parisc_device *pa_dev, struct lba_device *lba_dev)
  825. {
  826. unsigned long bytecnt;
  827. long io_count;
  828. long status; /* PDC return status */
  829. long pa_count;
  830. pdc_pat_cell_mod_maddr_block_t *pa_pdc_cell; /* PA_VIEW */
  831. pdc_pat_cell_mod_maddr_block_t *io_pdc_cell; /* IO_VIEW */
  832. int i;
  833. pa_pdc_cell = kzalloc(sizeof(pdc_pat_cell_mod_maddr_block_t), GFP_KERNEL);
  834. if (!pa_pdc_cell)
  835. return;
  836. io_pdc_cell = kzalloc(sizeof(pdc_pat_cell_mod_maddr_block_t), GFP_KERNEL);
  837. if (!io_pdc_cell) {
  838. kfree(pa_pdc_cell);
  839. return;
  840. }
  841. /* return cell module (IO view) */
  842. status = pdc_pat_cell_module(&bytecnt, pa_dev->pcell_loc, pa_dev->mod_index,
  843. PA_VIEW, pa_pdc_cell);
  844. pa_count = pa_pdc_cell->mod[1];
  845. status |= pdc_pat_cell_module(&bytecnt, pa_dev->pcell_loc, pa_dev->mod_index,
  846. IO_VIEW, io_pdc_cell);
  847. io_count = io_pdc_cell->mod[1];
  848. /* We've already done this once for device discovery...*/
  849. if (status != PDC_OK) {
  850. panic("pdc_pat_cell_module() call failed for LBA!\n");
  851. }
  852. if (PAT_GET_ENTITY(pa_pdc_cell->mod_info) != PAT_ENTITY_LBA) {
  853. panic("pdc_pat_cell_module() entity returned != PAT_ENTITY_LBA!\n");
  854. }
  855. /*
  856. ** Inspect the resources PAT tells us about
  857. */
  858. for (i = 0; i < pa_count; i++) {
  859. struct {
  860. unsigned long type;
  861. unsigned long start;
  862. unsigned long end; /* aka finish */
  863. } *p, *io;
  864. struct resource *r;
  865. p = (void *) &(pa_pdc_cell->mod[2+i*3]);
  866. io = (void *) &(io_pdc_cell->mod[2+i*3]);
  867. /* Convert the PAT range data to PCI "struct resource" */
  868. switch(p->type & 0xff) {
  869. case PAT_PBNUM:
  870. lba_dev->hba.bus_num.start = p->start;
  871. lba_dev->hba.bus_num.end = p->end;
  872. lba_dev->hba.bus_num.flags = IORESOURCE_BUS;
  873. break;
  874. case PAT_LMMIO:
  875. /* used to fix up pre-initialized MEM BARs */
  876. if (!lba_dev->hba.lmmio_space.flags) {
  877. unsigned long lba_len;
  878. lba_len = ~READ_REG32(lba_dev->hba.base_addr
  879. + LBA_LMMIO_MASK);
  880. if ((p->end - p->start) != lba_len)
  881. p->end = extend_lmmio_len(p->start,
  882. p->end, lba_len);
  883. sprintf(lba_dev->hba.lmmio_name,
  884. "PCI%02x LMMIO",
  885. (int)lba_dev->hba.bus_num.start);
  886. lba_dev->hba.lmmio_space_offset = p->start -
  887. io->start;
  888. r = &lba_dev->hba.lmmio_space;
  889. r->name = lba_dev->hba.lmmio_name;
  890. } else if (!lba_dev->hba.elmmio_space.flags) {
  891. sprintf(lba_dev->hba.elmmio_name,
  892. "PCI%02x ELMMIO",
  893. (int)lba_dev->hba.bus_num.start);
  894. r = &lba_dev->hba.elmmio_space;
  895. r->name = lba_dev->hba.elmmio_name;
  896. } else {
  897. printk(KERN_WARNING MODULE_NAME
  898. " only supports 2 LMMIO resources!\n");
  899. break;
  900. }
  901. r->start = p->start;
  902. r->end = p->end;
  903. r->flags = IORESOURCE_MEM;
  904. r->parent = r->sibling = r->child = NULL;
  905. break;
  906. case PAT_GMMIO:
  907. /* MMIO space > 4GB phys addr; for 64-bit BAR */
  908. sprintf(lba_dev->hba.gmmio_name, "PCI%02x GMMIO",
  909. (int)lba_dev->hba.bus_num.start);
  910. r = &lba_dev->hba.gmmio_space;
  911. r->name = lba_dev->hba.gmmio_name;
  912. r->start = p->start;
  913. r->end = p->end;
  914. r->flags = IORESOURCE_MEM;
  915. r->parent = r->sibling = r->child = NULL;
  916. break;
  917. case PAT_NPIOP:
  918. printk(KERN_WARNING MODULE_NAME
  919. " range[%d] : ignoring NPIOP (0x%lx)\n",
  920. i, p->start);
  921. break;
  922. case PAT_PIOP:
  923. /*
  924. ** Postable I/O port space is per PCI host adapter.
  925. ** base of 64MB PIOP region
  926. */
  927. lba_dev->iop_base = ioremap_nocache(p->start, 64 * 1024 * 1024);
  928. sprintf(lba_dev->hba.io_name, "PCI%02x Ports",
  929. (int)lba_dev->hba.bus_num.start);
  930. r = &lba_dev->hba.io_space;
  931. r->name = lba_dev->hba.io_name;
  932. r->start = HBA_PORT_BASE(lba_dev->hba.hba_num);
  933. r->end = r->start + HBA_PORT_SPACE_SIZE - 1;
  934. r->flags = IORESOURCE_IO;
  935. r->parent = r->sibling = r->child = NULL;
  936. break;
  937. default:
  938. printk(KERN_WARNING MODULE_NAME
  939. " range[%d] : unknown pat range type (0x%lx)\n",
  940. i, p->type & 0xff);
  941. break;
  942. }
  943. }
  944. kfree(pa_pdc_cell);
  945. kfree(io_pdc_cell);
  946. }
  947. #else
  948. /* keep compiler from complaining about missing declarations */
  949. #define lba_pat_port_ops lba_astro_port_ops
  950. #define lba_pat_resources(pa_dev, lba_dev)
  951. #endif /* CONFIG_64BIT */
  952. extern void sba_distributed_lmmio(struct parisc_device *, struct resource *);
  953. extern void sba_directed_lmmio(struct parisc_device *, struct resource *);
  954. static void
  955. lba_legacy_resources(struct parisc_device *pa_dev, struct lba_device *lba_dev)
  956. {
  957. struct resource *r;
  958. int lba_num;
  959. lba_dev->hba.lmmio_space_offset = PCI_F_EXTEND;
  960. /*
  961. ** With "legacy" firmware, the lowest byte of FW_SCRATCH
  962. ** represents bus->secondary and the second byte represents
  963. ** bus->subsidiary (i.e. highest PPB programmed by firmware).
  964. ** PCI bus walk *should* end up with the same result.
  965. ** FIXME: But we don't have sanity checks in PCI or LBA.
  966. */
  967. lba_num = READ_REG32(lba_dev->hba.base_addr + LBA_FW_SCRATCH);
  968. r = &(lba_dev->hba.bus_num);
  969. r->name = "LBA PCI Busses";
  970. r->start = lba_num & 0xff;
  971. r->end = (lba_num>>8) & 0xff;
  972. r->flags = IORESOURCE_BUS;
  973. /* Set up local PCI Bus resources - we don't need them for
  974. ** Legacy boxes but it's nice to see in /proc/iomem.
  975. */
  976. r = &(lba_dev->hba.lmmio_space);
  977. sprintf(lba_dev->hba.lmmio_name, "PCI%02x LMMIO",
  978. (int)lba_dev->hba.bus_num.start);
  979. r->name = lba_dev->hba.lmmio_name;
  980. #if 1
  981. /* We want the CPU -> IO routing of addresses.
  982. * The SBA BASE/MASK registers control CPU -> IO routing.
  983. * Ask SBA what is routed to this rope/LBA.
  984. */
  985. sba_distributed_lmmio(pa_dev, r);
  986. #else
  987. /*
  988. * The LBA BASE/MASK registers control IO -> System routing.
  989. *
  990. * The following code works but doesn't get us what we want.
  991. * Well, only because firmware (v5.0) on C3000 doesn't program
  992. * the LBA BASE/MASE registers to be the exact inverse of
  993. * the corresponding SBA registers. Other Astro/Pluto
  994. * based platform firmware may do it right.
  995. *
  996. * Should someone want to mess with MSI, they may need to
  997. * reprogram LBA BASE/MASK registers. Thus preserve the code
  998. * below until MSI is known to work on C3000/A500/N4000/RP3440.
  999. *
  1000. * Using the code below, /proc/iomem shows:
  1001. * ...
  1002. * f0000000-f0ffffff : PCI00 LMMIO
  1003. * f05d0000-f05d0000 : lcd_data
  1004. * f05d0008-f05d0008 : lcd_cmd
  1005. * f1000000-f1ffffff : PCI01 LMMIO
  1006. * f4000000-f4ffffff : PCI02 LMMIO
  1007. * f4000000-f4001fff : sym53c8xx
  1008. * f4002000-f4003fff : sym53c8xx
  1009. * f4004000-f40043ff : sym53c8xx
  1010. * f4005000-f40053ff : sym53c8xx
  1011. * f4007000-f4007fff : ohci_hcd
  1012. * f4008000-f40083ff : tulip
  1013. * f6000000-f6ffffff : PCI03 LMMIO
  1014. * f8000000-fbffffff : PCI00 ELMMIO
  1015. * fa100000-fa4fffff : stifb mmio
  1016. * fb000000-fb1fffff : stifb fb
  1017. *
  1018. * But everything listed under PCI02 actually lives under PCI00.
  1019. * This is clearly wrong.
  1020. *
  1021. * Asking SBA how things are routed tells the correct story:
  1022. * LMMIO_BASE/MASK/ROUTE f4000001 fc000000 00000000
  1023. * DIR0_BASE/MASK/ROUTE fa000001 fe000000 00000006
  1024. * DIR1_BASE/MASK/ROUTE f9000001 ff000000 00000004
  1025. * DIR2_BASE/MASK/ROUTE f0000000 fc000000 00000000
  1026. * DIR3_BASE/MASK/ROUTE f0000000 fc000000 00000000
  1027. *
  1028. * Which looks like this in /proc/iomem:
  1029. * f4000000-f47fffff : PCI00 LMMIO
  1030. * f4000000-f4001fff : sym53c8xx
  1031. * ...[deteled core devices - same as above]...
  1032. * f4008000-f40083ff : tulip
  1033. * f4800000-f4ffffff : PCI01 LMMIO
  1034. * f6000000-f67fffff : PCI02 LMMIO
  1035. * f7000000-f77fffff : PCI03 LMMIO
  1036. * f9000000-f9ffffff : PCI02 ELMMIO
  1037. * fa000000-fbffffff : PCI03 ELMMIO
  1038. * fa100000-fa4fffff : stifb mmio
  1039. * fb000000-fb1fffff : stifb fb
  1040. *
  1041. * ie all Built-in core are under now correctly under PCI00.
  1042. * The "PCI02 ELMMIO" directed range is for:
  1043. * +-[02]---03.0 3Dfx Interactive, Inc. Voodoo 2
  1044. *
  1045. * All is well now.
  1046. */
  1047. r->start = READ_REG32(lba_dev->hba.base_addr + LBA_LMMIO_BASE);
  1048. if (r->start & 1) {
  1049. unsigned long rsize;
  1050. r->flags = IORESOURCE_MEM;
  1051. /* mmio_mask also clears Enable bit */
  1052. r->start &= mmio_mask;
  1053. r->start = PCI_HOST_ADDR(HBA_DATA(lba_dev), r->start);
  1054. rsize = ~ READ_REG32(lba_dev->hba.base_addr + LBA_LMMIO_MASK);
  1055. /*
  1056. ** Each rope only gets part of the distributed range.
  1057. ** Adjust "window" for this rope.
  1058. */
  1059. rsize /= ROPES_PER_IOC;
  1060. r->start += (rsize + 1) * LBA_NUM(pa_dev->hpa.start);
  1061. r->end = r->start + rsize;
  1062. } else {
  1063. r->end = r->start = 0; /* Not enabled. */
  1064. }
  1065. #endif
  1066. /*
  1067. ** "Directed" ranges are used when the "distributed range" isn't
  1068. ** sufficient for all devices below a given LBA. Typically devices
  1069. ** like graphics cards or X25 may need a directed range when the
  1070. ** bus has multiple slots (ie multiple devices) or the device
  1071. ** needs more than the typical 4 or 8MB a distributed range offers.
  1072. **
  1073. ** The main reason for ignoring it now frigging complications.
  1074. ** Directed ranges may overlap (and have precedence) over
  1075. ** distributed ranges. Or a distributed range assigned to a unused
  1076. ** rope may be used by a directed range on a different rope.
  1077. ** Support for graphics devices may require fixing this
  1078. ** since they may be assigned a directed range which overlaps
  1079. ** an existing (but unused portion of) distributed range.
  1080. */
  1081. r = &(lba_dev->hba.elmmio_space);
  1082. sprintf(lba_dev->hba.elmmio_name, "PCI%02x ELMMIO",
  1083. (int)lba_dev->hba.bus_num.start);
  1084. r->name = lba_dev->hba.elmmio_name;
  1085. #if 1
  1086. /* See comment which precedes call to sba_directed_lmmio() */
  1087. sba_directed_lmmio(pa_dev, r);
  1088. #else
  1089. r->start = READ_REG32(lba_dev->hba.base_addr + LBA_ELMMIO_BASE);
  1090. if (r->start & 1) {
  1091. unsigned long rsize;
  1092. r->flags = IORESOURCE_MEM;
  1093. /* mmio_mask also clears Enable bit */
  1094. r->start &= mmio_mask;
  1095. r->start = PCI_HOST_ADDR(HBA_DATA(lba_dev), r->start);
  1096. rsize = READ_REG32(lba_dev->hba.base_addr + LBA_ELMMIO_MASK);
  1097. r->end = r->start + ~rsize;
  1098. }
  1099. #endif
  1100. r = &(lba_dev->hba.io_space);
  1101. sprintf(lba_dev->hba.io_name, "PCI%02x Ports",
  1102. (int)lba_dev->hba.bus_num.start);
  1103. r->name = lba_dev->hba.io_name;
  1104. r->flags = IORESOURCE_IO;
  1105. r->start = READ_REG32(lba_dev->hba.base_addr + LBA_IOS_BASE) & ~1L;
  1106. r->end = r->start + (READ_REG32(lba_dev->hba.base_addr + LBA_IOS_MASK) ^ (HBA_PORT_SPACE_SIZE - 1));
  1107. /* Virtualize the I/O Port space ranges */
  1108. lba_num = HBA_PORT_BASE(lba_dev->hba.hba_num);
  1109. r->start |= lba_num;
  1110. r->end |= lba_num;
  1111. }
  1112. /**************************************************************************
  1113. **
  1114. ** LBA initialization code (HW and SW)
  1115. **
  1116. ** o identify LBA chip itself
  1117. ** o initialize LBA chip modes (HardFail)
  1118. ** o FIXME: initialize DMA hints for reasonable defaults
  1119. ** o enable configuration functions
  1120. ** o call pci_register_ops() to discover devs (fixup/fixup_bus get invoked)
  1121. **
  1122. **************************************************************************/
  1123. static int __init
  1124. lba_hw_init(struct lba_device *d)
  1125. {
  1126. u32 stat;
  1127. u32 bus_reset; /* PDC_PAT_BUG */
  1128. #if 0
  1129. printk(KERN_DEBUG "LBA %lx STAT_CTL %Lx ERROR_CFG %Lx STATUS %Lx DMA_CTL %Lx\n",
  1130. d->hba.base_addr,
  1131. READ_REG64(d->hba.base_addr + LBA_STAT_CTL),
  1132. READ_REG64(d->hba.base_addr + LBA_ERROR_CONFIG),
  1133. READ_REG64(d->hba.base_addr + LBA_ERROR_STATUS),
  1134. READ_REG64(d->hba.base_addr + LBA_DMA_CTL) );
  1135. printk(KERN_DEBUG " ARB mask %Lx pri %Lx mode %Lx mtlt %Lx\n",
  1136. READ_REG64(d->hba.base_addr + LBA_ARB_MASK),
  1137. READ_REG64(d->hba.base_addr + LBA_ARB_PRI),
  1138. READ_REG64(d->hba.base_addr + LBA_ARB_MODE),
  1139. READ_REG64(d->hba.base_addr + LBA_ARB_MTLT) );
  1140. printk(KERN_DEBUG " HINT cfg 0x%Lx\n",
  1141. READ_REG64(d->hba.base_addr + LBA_HINT_CFG));
  1142. printk(KERN_DEBUG " HINT reg ");
  1143. { int i;
  1144. for (i=LBA_HINT_BASE; i< (14*8 + LBA_HINT_BASE); i+=8)
  1145. printk(" %Lx", READ_REG64(d->hba.base_addr + i));
  1146. }
  1147. printk("\n");
  1148. #endif /* DEBUG_LBA_PAT */
  1149. #ifdef CONFIG_64BIT
  1150. /*
  1151. * FIXME add support for PDC_PAT_IO "Get slot status" - OLAR support
  1152. * Only N-Class and up can really make use of Get slot status.
  1153. * maybe L-class too but I've never played with it there.
  1154. */
  1155. #endif
  1156. /* PDC_PAT_BUG: exhibited in rev 40.48 on L2000 */
  1157. bus_reset = READ_REG32(d->hba.base_addr + LBA_STAT_CTL + 4) & 1;
  1158. if (bus_reset) {
  1159. printk(KERN_DEBUG "NOTICE: PCI bus reset still asserted! (clearing)\n");
  1160. }
  1161. stat = READ_REG32(d->hba.base_addr + LBA_ERROR_CONFIG);
  1162. if (stat & LBA_SMART_MODE) {
  1163. printk(KERN_DEBUG "NOTICE: LBA in SMART mode! (cleared)\n");
  1164. stat &= ~LBA_SMART_MODE;
  1165. WRITE_REG32(stat, d->hba.base_addr + LBA_ERROR_CONFIG);
  1166. }
  1167. /* Set HF mode as the default (vs. -1 mode). */
  1168. stat = READ_REG32(d->hba.base_addr + LBA_STAT_CTL);
  1169. WRITE_REG32(stat | HF_ENABLE, d->hba.base_addr + LBA_STAT_CTL);
  1170. /*
  1171. ** Writing a zero to STAT_CTL.rf (bit 0) will clear reset signal
  1172. ** if it's not already set. If we just cleared the PCI Bus Reset
  1173. ** signal, wait a bit for the PCI devices to recover and setup.
  1174. */
  1175. if (bus_reset)
  1176. mdelay(pci_post_reset_delay);
  1177. if (0 == READ_REG32(d->hba.base_addr + LBA_ARB_MASK)) {
  1178. /*
  1179. ** PDC_PAT_BUG: PDC rev 40.48 on L2000.
  1180. ** B2000/C3600/J6000 also have this problem?
  1181. **
  1182. ** Elroys with hot pluggable slots don't get configured
  1183. ** correctly if the slot is empty. ARB_MASK is set to 0
  1184. ** and we can't master transactions on the bus if it's
  1185. ** not at least one. 0x3 enables elroy and first slot.
  1186. */
  1187. printk(KERN_DEBUG "NOTICE: Enabling PCI Arbitration\n");
  1188. WRITE_REG32(0x3, d->hba.base_addr + LBA_ARB_MASK);
  1189. }
  1190. /*
  1191. ** FIXME: Hint registers are programmed with default hint
  1192. ** values by firmware. Hints should be sane even if we
  1193. ** can't reprogram them the way drivers want.
  1194. */
  1195. return 0;
  1196. }
  1197. /*
  1198. * Unfortunately, when firmware numbers busses, it doesn't take into account
  1199. * Cardbus bridges. So we have to renumber the busses to suit ourselves.
  1200. * Elroy/Mercury don't actually know what bus number they're attached to;
  1201. * we use bus 0 to indicate the directly attached bus and any other bus
  1202. * number will be taken care of by the PCI-PCI bridge.
  1203. */
  1204. static unsigned int lba_next_bus = 0;
  1205. /*
  1206. * Determine if lba should claim this chip (return 0) or not (return 1).
  1207. * If so, initialize the chip and tell other partners in crime they
  1208. * have work to do.
  1209. */
  1210. static int __init
  1211. lba_driver_probe(struct parisc_device *dev)
  1212. {
  1213. struct lba_device *lba_dev;
  1214. LIST_HEAD(resources);
  1215. struct pci_bus *lba_bus;
  1216. struct pci_ops *cfg_ops;
  1217. u32 func_class;
  1218. void *tmp_obj;
  1219. char *version;
  1220. void __iomem *addr = ioremap_nocache(dev->hpa.start, 4096);
  1221. int max;
  1222. /* Read HW Rev First */
  1223. func_class = READ_REG32(addr + LBA_FCLASS);
  1224. if (IS_ELROY(dev)) {
  1225. func_class &= 0xf;
  1226. switch (func_class) {
  1227. case 0: version = "TR1.0"; break;
  1228. case 1: version = "TR2.0"; break;
  1229. case 2: version = "TR2.1"; break;
  1230. case 3: version = "TR2.2"; break;
  1231. case 4: version = "TR3.0"; break;
  1232. case 5: version = "TR4.0"; break;
  1233. default: version = "TR4+";
  1234. }
  1235. printk(KERN_INFO "Elroy version %s (0x%x) found at 0x%lx\n",
  1236. version, func_class & 0xf, (long)dev->hpa.start);
  1237. if (func_class < 2) {
  1238. printk(KERN_WARNING "Can't support LBA older than "
  1239. "TR2.1 - continuing under adversity.\n");
  1240. }
  1241. #if 0
  1242. /* Elroy TR4.0 should work with simple algorithm.
  1243. But it doesn't. Still missing something. *sigh*
  1244. */
  1245. if (func_class > 4) {
  1246. cfg_ops = &mercury_cfg_ops;
  1247. } else
  1248. #endif
  1249. {
  1250. cfg_ops = &elroy_cfg_ops;
  1251. }
  1252. } else if (IS_MERCURY(dev) || IS_QUICKSILVER(dev)) {
  1253. int major, minor;
  1254. func_class &= 0xff;
  1255. major = func_class >> 4, minor = func_class & 0xf;
  1256. /* We could use one printk for both Elroy and Mercury,
  1257. * but for the mask for func_class.
  1258. */
  1259. printk(KERN_INFO "%s version TR%d.%d (0x%x) found at 0x%lx\n",
  1260. IS_MERCURY(dev) ? "Mercury" : "Quicksilver", major,
  1261. minor, func_class, (long)dev->hpa.start);
  1262. cfg_ops = &mercury_cfg_ops;
  1263. } else {
  1264. printk(KERN_ERR "Unknown LBA found at 0x%lx\n",
  1265. (long)dev->hpa.start);
  1266. return -ENODEV;
  1267. }
  1268. /* Tell I/O SAPIC driver we have a IRQ handler/region. */
  1269. tmp_obj = iosapic_register(dev->hpa.start + LBA_IOSAPIC_BASE);
  1270. /* NOTE: PCI devices (e.g. 103c:1005 graphics card) which don't
  1271. ** have an IRT entry will get NULL back from iosapic code.
  1272. */
  1273. lba_dev = kzalloc(sizeof(struct lba_device), GFP_KERNEL);
  1274. if (!lba_dev) {
  1275. printk(KERN_ERR "lba_init_chip - couldn't alloc lba_device\n");
  1276. return(1);
  1277. }
  1278. /* ---------- First : initialize data we already have --------- */
  1279. lba_dev->hw_rev = func_class;
  1280. lba_dev->hba.base_addr = addr;
  1281. lba_dev->hba.dev = dev;
  1282. lba_dev->iosapic_obj = tmp_obj; /* save interrupt handle */
  1283. lba_dev->hba.iommu = sba_get_iommu(dev); /* get iommu data */
  1284. parisc_set_drvdata(dev, lba_dev);
  1285. /* ------------ Second : initialize common stuff ---------- */
  1286. pci_bios = &lba_bios_ops;
  1287. pcibios_register_hba(HBA_DATA(lba_dev));
  1288. spin_lock_init(&lba_dev->lba_lock);
  1289. if (lba_hw_init(lba_dev))
  1290. return(1);
  1291. /* ---------- Third : setup I/O Port and MMIO resources --------- */
  1292. if (is_pdc_pat()) {
  1293. /* PDC PAT firmware uses PIOP region of GMMIO space. */
  1294. pci_port = &lba_pat_port_ops;
  1295. /* Go ask PDC PAT what resources this LBA has */
  1296. lba_pat_resources(dev, lba_dev);
  1297. } else {
  1298. if (!astro_iop_base) {
  1299. /* Sprockets PDC uses NPIOP region */
  1300. astro_iop_base = ioremap_nocache(LBA_PORT_BASE, 64 * 1024);
  1301. pci_port = &lba_astro_port_ops;
  1302. }
  1303. /* Poke the chip a bit for /proc output */
  1304. lba_legacy_resources(dev, lba_dev);
  1305. }
  1306. if (lba_dev->hba.bus_num.start < lba_next_bus)
  1307. lba_dev->hba.bus_num.start = lba_next_bus;
  1308. /* Overlaps with elmmio can (and should) fail here.
  1309. * We will prune (or ignore) the distributed range.
  1310. *
  1311. * FIXME: SBA code should register all elmmio ranges first.
  1312. * that would take care of elmmio ranges routed
  1313. * to a different rope (already discovered) from
  1314. * getting registered *after* LBA code has already
  1315. * registered it's distributed lmmio range.
  1316. */
  1317. if (truncate_pat_collision(&iomem_resource,
  1318. &(lba_dev->hba.lmmio_space))) {
  1319. printk(KERN_WARNING "LBA: lmmio_space [%lx/%lx] duplicate!\n",
  1320. (long)lba_dev->hba.lmmio_space.start,
  1321. (long)lba_dev->hba.lmmio_space.end);
  1322. lba_dev->hba.lmmio_space.flags = 0;
  1323. }
  1324. pci_add_resource_offset(&resources, &lba_dev->hba.io_space,
  1325. HBA_PORT_BASE(lba_dev->hba.hba_num));
  1326. if (lba_dev->hba.elmmio_space.flags)
  1327. pci_add_resource_offset(&resources, &lba_dev->hba.elmmio_space,
  1328. lba_dev->hba.lmmio_space_offset);
  1329. if (lba_dev->hba.lmmio_space.flags)
  1330. pci_add_resource_offset(&resources, &lba_dev->hba.lmmio_space,
  1331. lba_dev->hba.lmmio_space_offset);
  1332. if (lba_dev->hba.gmmio_space.flags)
  1333. pci_add_resource(&resources, &lba_dev->hba.gmmio_space);
  1334. pci_add_resource(&resources, &lba_dev->hba.bus_num);
  1335. dev->dev.platform_data = lba_dev;
  1336. lba_bus = lba_dev->hba.hba_bus =
  1337. pci_create_root_bus(&dev->dev, lba_dev->hba.bus_num.start,
  1338. cfg_ops, NULL, &resources);
  1339. if (!lba_bus) {
  1340. pci_free_resource_list(&resources);
  1341. return 0;
  1342. }
  1343. max = pci_scan_child_bus(lba_bus);
  1344. /* This is in lieu of calling pci_assign_unassigned_resources() */
  1345. if (is_pdc_pat()) {
  1346. /* assign resources to un-initialized devices */
  1347. DBG_PAT("LBA pci_bus_size_bridges()\n");
  1348. pci_bus_size_bridges(lba_bus);
  1349. DBG_PAT("LBA pci_bus_assign_resources()\n");
  1350. pci_bus_assign_resources(lba_bus);
  1351. #ifdef DEBUG_LBA_PAT
  1352. DBG_PAT("\nLBA PIOP resource tree\n");
  1353. lba_dump_res(&lba_dev->hba.io_space, 2);
  1354. DBG_PAT("\nLBA LMMIO resource tree\n");
  1355. lba_dump_res(&lba_dev->hba.lmmio_space, 2);
  1356. #endif
  1357. }
  1358. /*
  1359. ** Once PCI register ops has walked the bus, access to config
  1360. ** space is restricted. Avoids master aborts on config cycles.
  1361. ** Early LBA revs go fatal on *any* master abort.
  1362. */
  1363. if (cfg_ops == &elroy_cfg_ops) {
  1364. lba_dev->flags |= LBA_FLAG_SKIP_PROBE;
  1365. }
  1366. lba_next_bus = max + 1;
  1367. pci_bus_add_devices(lba_bus);
  1368. /* Whew! Finally done! Tell services we got this one covered. */
  1369. return 0;
  1370. }
  1371. static struct parisc_device_id lba_tbl[] = {
  1372. { HPHW_BRIDGE, HVERSION_REV_ANY_ID, ELROY_HVERS, 0xa },
  1373. { HPHW_BRIDGE, HVERSION_REV_ANY_ID, MERCURY_HVERS, 0xa },
  1374. { HPHW_BRIDGE, HVERSION_REV_ANY_ID, QUICKSILVER_HVERS, 0xa },
  1375. { 0, }
  1376. };
  1377. static struct parisc_driver lba_driver = {
  1378. .name = MODULE_NAME,
  1379. .id_table = lba_tbl,
  1380. .probe = lba_driver_probe,
  1381. };
  1382. /*
  1383. ** One time initialization to let the world know the LBA was found.
  1384. ** Must be called exactly once before pci_init().
  1385. */
  1386. void __init lba_init(void)
  1387. {
  1388. register_parisc_driver(&lba_driver);
  1389. }
  1390. /*
  1391. ** Initialize the IBASE/IMASK registers for LBA (Elroy).
  1392. ** Only called from sba_iommu.c in order to route ranges (MMIO vs DMA).
  1393. ** sba_iommu is responsible for locking (none needed at init time).
  1394. */
  1395. void lba_set_iregs(struct parisc_device *lba, u32 ibase, u32 imask)
  1396. {
  1397. void __iomem * base_addr = ioremap_nocache(lba->hpa.start, 4096);
  1398. imask <<= 2; /* adjust for hints - 2 more bits */
  1399. /* Make sure we aren't trying to set bits that aren't writeable. */
  1400. WARN_ON((ibase & 0x001fffff) != 0);
  1401. WARN_ON((imask & 0x001fffff) != 0);
  1402. DBG("%s() ibase 0x%x imask 0x%x\n", __func__, ibase, imask);
  1403. WRITE_REG32( imask, base_addr + LBA_IMASK);
  1404. WRITE_REG32( ibase, base_addr + LBA_IBASE);
  1405. iounmap(base_addr);
  1406. }