sdhci.c 38 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556
  1. /*
  2. * linux/drivers/mmc/sdhci.c - Secure Digital Host Controller Interface driver
  3. *
  4. * Copyright (C) 2005-2006 Pierre Ossman, All Rights Reserved.
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation; either version 2 of the License, or (at
  9. * your option) any later version.
  10. */
  11. #include <linux/delay.h>
  12. #include <linux/highmem.h>
  13. #include <linux/pci.h>
  14. #include <linux/dma-mapping.h>
  15. #include <linux/mmc/host.h>
  16. #include <linux/mmc/protocol.h>
  17. #include <asm/scatterlist.h>
  18. #include "sdhci.h"
  19. #define DRIVER_NAME "sdhci"
  20. #define BUGMAIL "<sdhci-devel@list.drzeus.cx>"
  21. #define DBG(f, x...) \
  22. pr_debug(DRIVER_NAME " [%s()]: " f, __func__,## x)
  23. static unsigned int debug_nodma = 0;
  24. static unsigned int debug_forcedma = 0;
  25. static unsigned int debug_quirks = 0;
  26. #define SDHCI_QUIRK_CLOCK_BEFORE_RESET (1<<0)
  27. #define SDHCI_QUIRK_FORCE_DMA (1<<1)
  28. /* Controller doesn't like some resets when there is no card inserted. */
  29. #define SDHCI_QUIRK_NO_CARD_NO_RESET (1<<2)
  30. #define SDHCI_QUIRK_SINGLE_POWER_WRITE (1<<3)
  31. static const struct pci_device_id pci_ids[] __devinitdata = {
  32. {
  33. .vendor = PCI_VENDOR_ID_RICOH,
  34. .device = PCI_DEVICE_ID_RICOH_R5C822,
  35. .subvendor = PCI_VENDOR_ID_IBM,
  36. .subdevice = PCI_ANY_ID,
  37. .driver_data = SDHCI_QUIRK_CLOCK_BEFORE_RESET |
  38. SDHCI_QUIRK_FORCE_DMA,
  39. },
  40. {
  41. .vendor = PCI_VENDOR_ID_RICOH,
  42. .device = PCI_DEVICE_ID_RICOH_R5C822,
  43. .subvendor = PCI_ANY_ID,
  44. .subdevice = PCI_ANY_ID,
  45. .driver_data = SDHCI_QUIRK_FORCE_DMA |
  46. SDHCI_QUIRK_NO_CARD_NO_RESET,
  47. },
  48. {
  49. .vendor = PCI_VENDOR_ID_TI,
  50. .device = PCI_DEVICE_ID_TI_XX21_XX11_SD,
  51. .subvendor = PCI_ANY_ID,
  52. .subdevice = PCI_ANY_ID,
  53. .driver_data = SDHCI_QUIRK_FORCE_DMA,
  54. },
  55. {
  56. .vendor = PCI_VENDOR_ID_ENE,
  57. .device = PCI_DEVICE_ID_ENE_CB712_SD,
  58. .subvendor = PCI_ANY_ID,
  59. .subdevice = PCI_ANY_ID,
  60. .driver_data = SDHCI_QUIRK_SINGLE_POWER_WRITE,
  61. },
  62. { /* Generic SD host controller */
  63. PCI_DEVICE_CLASS((PCI_CLASS_SYSTEM_SDHCI << 8), 0xFFFF00)
  64. },
  65. { /* end: all zeroes */ },
  66. };
  67. MODULE_DEVICE_TABLE(pci, pci_ids);
  68. static void sdhci_prepare_data(struct sdhci_host *, struct mmc_data *);
  69. static void sdhci_finish_data(struct sdhci_host *);
  70. static void sdhci_send_command(struct sdhci_host *, struct mmc_command *);
  71. static void sdhci_finish_command(struct sdhci_host *);
  72. static void sdhci_dumpregs(struct sdhci_host *host)
  73. {
  74. printk(KERN_DEBUG DRIVER_NAME ": ============== REGISTER DUMP ==============\n");
  75. printk(KERN_DEBUG DRIVER_NAME ": Sys addr: 0x%08x | Version: 0x%08x\n",
  76. readl(host->ioaddr + SDHCI_DMA_ADDRESS),
  77. readw(host->ioaddr + SDHCI_HOST_VERSION));
  78. printk(KERN_DEBUG DRIVER_NAME ": Blk size: 0x%08x | Blk cnt: 0x%08x\n",
  79. readw(host->ioaddr + SDHCI_BLOCK_SIZE),
  80. readw(host->ioaddr + SDHCI_BLOCK_COUNT));
  81. printk(KERN_DEBUG DRIVER_NAME ": Argument: 0x%08x | Trn mode: 0x%08x\n",
  82. readl(host->ioaddr + SDHCI_ARGUMENT),
  83. readw(host->ioaddr + SDHCI_TRANSFER_MODE));
  84. printk(KERN_DEBUG DRIVER_NAME ": Present: 0x%08x | Host ctl: 0x%08x\n",
  85. readl(host->ioaddr + SDHCI_PRESENT_STATE),
  86. readb(host->ioaddr + SDHCI_HOST_CONTROL));
  87. printk(KERN_DEBUG DRIVER_NAME ": Power: 0x%08x | Blk gap: 0x%08x\n",
  88. readb(host->ioaddr + SDHCI_POWER_CONTROL),
  89. readb(host->ioaddr + SDHCI_BLOCK_GAP_CONTROL));
  90. printk(KERN_DEBUG DRIVER_NAME ": Wake-up: 0x%08x | Clock: 0x%08x\n",
  91. readb(host->ioaddr + SDHCI_WALK_UP_CONTROL),
  92. readw(host->ioaddr + SDHCI_CLOCK_CONTROL));
  93. printk(KERN_DEBUG DRIVER_NAME ": Timeout: 0x%08x | Int stat: 0x%08x\n",
  94. readb(host->ioaddr + SDHCI_TIMEOUT_CONTROL),
  95. readl(host->ioaddr + SDHCI_INT_STATUS));
  96. printk(KERN_DEBUG DRIVER_NAME ": Int enab: 0x%08x | Sig enab: 0x%08x\n",
  97. readl(host->ioaddr + SDHCI_INT_ENABLE),
  98. readl(host->ioaddr + SDHCI_SIGNAL_ENABLE));
  99. printk(KERN_DEBUG DRIVER_NAME ": AC12 err: 0x%08x | Slot int: 0x%08x\n",
  100. readw(host->ioaddr + SDHCI_ACMD12_ERR),
  101. readw(host->ioaddr + SDHCI_SLOT_INT_STATUS));
  102. printk(KERN_DEBUG DRIVER_NAME ": Caps: 0x%08x | Max curr: 0x%08x\n",
  103. readl(host->ioaddr + SDHCI_CAPABILITIES),
  104. readl(host->ioaddr + SDHCI_MAX_CURRENT));
  105. printk(KERN_DEBUG DRIVER_NAME ": ===========================================\n");
  106. }
  107. /*****************************************************************************\
  108. * *
  109. * Low level functions *
  110. * *
  111. \*****************************************************************************/
  112. static void sdhci_reset(struct sdhci_host *host, u8 mask)
  113. {
  114. unsigned long timeout;
  115. if (host->chip->quirks & SDHCI_QUIRK_NO_CARD_NO_RESET) {
  116. if (!(readl(host->ioaddr + SDHCI_PRESENT_STATE) &
  117. SDHCI_CARD_PRESENT))
  118. return;
  119. }
  120. writeb(mask, host->ioaddr + SDHCI_SOFTWARE_RESET);
  121. if (mask & SDHCI_RESET_ALL)
  122. host->clock = 0;
  123. /* Wait max 100 ms */
  124. timeout = 100;
  125. /* hw clears the bit when it's done */
  126. while (readb(host->ioaddr + SDHCI_SOFTWARE_RESET) & mask) {
  127. if (timeout == 0) {
  128. printk(KERN_ERR "%s: Reset 0x%x never completed. "
  129. "Please report this to " BUGMAIL ".\n",
  130. mmc_hostname(host->mmc), (int)mask);
  131. sdhci_dumpregs(host);
  132. return;
  133. }
  134. timeout--;
  135. mdelay(1);
  136. }
  137. }
  138. static void sdhci_init(struct sdhci_host *host)
  139. {
  140. u32 intmask;
  141. sdhci_reset(host, SDHCI_RESET_ALL);
  142. intmask = SDHCI_INT_BUS_POWER | SDHCI_INT_DATA_END_BIT |
  143. SDHCI_INT_DATA_CRC | SDHCI_INT_DATA_TIMEOUT | SDHCI_INT_INDEX |
  144. SDHCI_INT_END_BIT | SDHCI_INT_CRC | SDHCI_INT_TIMEOUT |
  145. SDHCI_INT_CARD_REMOVE | SDHCI_INT_CARD_INSERT |
  146. SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL |
  147. SDHCI_INT_DMA_END | SDHCI_INT_DATA_END | SDHCI_INT_RESPONSE;
  148. writel(intmask, host->ioaddr + SDHCI_INT_ENABLE);
  149. writel(intmask, host->ioaddr + SDHCI_SIGNAL_ENABLE);
  150. }
  151. static void sdhci_activate_led(struct sdhci_host *host)
  152. {
  153. u8 ctrl;
  154. ctrl = readb(host->ioaddr + SDHCI_HOST_CONTROL);
  155. ctrl |= SDHCI_CTRL_LED;
  156. writeb(ctrl, host->ioaddr + SDHCI_HOST_CONTROL);
  157. }
  158. static void sdhci_deactivate_led(struct sdhci_host *host)
  159. {
  160. u8 ctrl;
  161. ctrl = readb(host->ioaddr + SDHCI_HOST_CONTROL);
  162. ctrl &= ~SDHCI_CTRL_LED;
  163. writeb(ctrl, host->ioaddr + SDHCI_HOST_CONTROL);
  164. }
  165. /*****************************************************************************\
  166. * *
  167. * Core functions *
  168. * *
  169. \*****************************************************************************/
  170. static inline char* sdhci_sg_to_buffer(struct sdhci_host* host)
  171. {
  172. return page_address(host->cur_sg->page) + host->cur_sg->offset;
  173. }
  174. static inline int sdhci_next_sg(struct sdhci_host* host)
  175. {
  176. /*
  177. * Skip to next SG entry.
  178. */
  179. host->cur_sg++;
  180. host->num_sg--;
  181. /*
  182. * Any entries left?
  183. */
  184. if (host->num_sg > 0) {
  185. host->offset = 0;
  186. host->remain = host->cur_sg->length;
  187. }
  188. return host->num_sg;
  189. }
  190. static void sdhci_read_block_pio(struct sdhci_host *host)
  191. {
  192. int blksize, chunk_remain;
  193. u32 data;
  194. char *buffer;
  195. int size;
  196. DBG("PIO reading\n");
  197. blksize = host->data->blksz;
  198. chunk_remain = 0;
  199. data = 0;
  200. buffer = sdhci_sg_to_buffer(host) + host->offset;
  201. while (blksize) {
  202. if (chunk_remain == 0) {
  203. data = readl(host->ioaddr + SDHCI_BUFFER);
  204. chunk_remain = min(blksize, 4);
  205. }
  206. size = min(host->size, host->remain);
  207. size = min(size, chunk_remain);
  208. chunk_remain -= size;
  209. blksize -= size;
  210. host->offset += size;
  211. host->remain -= size;
  212. host->size -= size;
  213. while (size) {
  214. *buffer = data & 0xFF;
  215. buffer++;
  216. data >>= 8;
  217. size--;
  218. }
  219. if (host->remain == 0) {
  220. if (sdhci_next_sg(host) == 0) {
  221. BUG_ON(blksize != 0);
  222. return;
  223. }
  224. buffer = sdhci_sg_to_buffer(host);
  225. }
  226. }
  227. }
  228. static void sdhci_write_block_pio(struct sdhci_host *host)
  229. {
  230. int blksize, chunk_remain;
  231. u32 data;
  232. char *buffer;
  233. int bytes, size;
  234. DBG("PIO writing\n");
  235. blksize = host->data->blksz;
  236. chunk_remain = 4;
  237. data = 0;
  238. bytes = 0;
  239. buffer = sdhci_sg_to_buffer(host) + host->offset;
  240. while (blksize) {
  241. size = min(host->size, host->remain);
  242. size = min(size, chunk_remain);
  243. chunk_remain -= size;
  244. blksize -= size;
  245. host->offset += size;
  246. host->remain -= size;
  247. host->size -= size;
  248. while (size) {
  249. data >>= 8;
  250. data |= (u32)*buffer << 24;
  251. buffer++;
  252. size--;
  253. }
  254. if (chunk_remain == 0) {
  255. writel(data, host->ioaddr + SDHCI_BUFFER);
  256. chunk_remain = min(blksize, 4);
  257. }
  258. if (host->remain == 0) {
  259. if (sdhci_next_sg(host) == 0) {
  260. BUG_ON(blksize != 0);
  261. return;
  262. }
  263. buffer = sdhci_sg_to_buffer(host);
  264. }
  265. }
  266. }
  267. static void sdhci_transfer_pio(struct sdhci_host *host)
  268. {
  269. u32 mask;
  270. BUG_ON(!host->data);
  271. if (host->size == 0)
  272. return;
  273. if (host->data->flags & MMC_DATA_READ)
  274. mask = SDHCI_DATA_AVAILABLE;
  275. else
  276. mask = SDHCI_SPACE_AVAILABLE;
  277. while (readl(host->ioaddr + SDHCI_PRESENT_STATE) & mask) {
  278. if (host->data->flags & MMC_DATA_READ)
  279. sdhci_read_block_pio(host);
  280. else
  281. sdhci_write_block_pio(host);
  282. if (host->size == 0)
  283. break;
  284. BUG_ON(host->num_sg == 0);
  285. }
  286. DBG("PIO transfer complete.\n");
  287. }
  288. static void sdhci_prepare_data(struct sdhci_host *host, struct mmc_data *data)
  289. {
  290. u8 count;
  291. unsigned target_timeout, current_timeout;
  292. WARN_ON(host->data);
  293. if (data == NULL)
  294. return;
  295. DBG("blksz %04x blks %04x flags %08x\n",
  296. data->blksz, data->blocks, data->flags);
  297. DBG("tsac %d ms nsac %d clk\n",
  298. data->timeout_ns / 1000000, data->timeout_clks);
  299. /* Sanity checks */
  300. BUG_ON(data->blksz * data->blocks > 524288);
  301. BUG_ON(data->blksz > host->mmc->max_blk_size);
  302. BUG_ON(data->blocks > 65535);
  303. /* timeout in us */
  304. target_timeout = data->timeout_ns / 1000 +
  305. data->timeout_clks / host->clock;
  306. /*
  307. * Figure out needed cycles.
  308. * We do this in steps in order to fit inside a 32 bit int.
  309. * The first step is the minimum timeout, which will have a
  310. * minimum resolution of 6 bits:
  311. * (1) 2^13*1000 > 2^22,
  312. * (2) host->timeout_clk < 2^16
  313. * =>
  314. * (1) / (2) > 2^6
  315. */
  316. count = 0;
  317. current_timeout = (1 << 13) * 1000 / host->timeout_clk;
  318. while (current_timeout < target_timeout) {
  319. count++;
  320. current_timeout <<= 1;
  321. if (count >= 0xF)
  322. break;
  323. }
  324. if (count >= 0xF) {
  325. printk(KERN_WARNING "%s: Too large timeout requested!\n",
  326. mmc_hostname(host->mmc));
  327. count = 0xE;
  328. }
  329. writeb(count, host->ioaddr + SDHCI_TIMEOUT_CONTROL);
  330. if (host->flags & SDHCI_USE_DMA) {
  331. int count;
  332. count = pci_map_sg(host->chip->pdev, data->sg, data->sg_len,
  333. (data->flags & MMC_DATA_READ)?PCI_DMA_FROMDEVICE:PCI_DMA_TODEVICE);
  334. BUG_ON(count != 1);
  335. writel(sg_dma_address(data->sg), host->ioaddr + SDHCI_DMA_ADDRESS);
  336. } else {
  337. host->size = data->blksz * data->blocks;
  338. host->cur_sg = data->sg;
  339. host->num_sg = data->sg_len;
  340. host->offset = 0;
  341. host->remain = host->cur_sg->length;
  342. }
  343. /* We do not handle DMA boundaries, so set it to max (512 KiB) */
  344. writew(SDHCI_MAKE_BLKSZ(7, data->blksz),
  345. host->ioaddr + SDHCI_BLOCK_SIZE);
  346. writew(data->blocks, host->ioaddr + SDHCI_BLOCK_COUNT);
  347. }
  348. static void sdhci_set_transfer_mode(struct sdhci_host *host,
  349. struct mmc_data *data)
  350. {
  351. u16 mode;
  352. WARN_ON(host->data);
  353. if (data == NULL)
  354. return;
  355. mode = SDHCI_TRNS_BLK_CNT_EN;
  356. if (data->blocks > 1)
  357. mode |= SDHCI_TRNS_MULTI;
  358. if (data->flags & MMC_DATA_READ)
  359. mode |= SDHCI_TRNS_READ;
  360. if (host->flags & SDHCI_USE_DMA)
  361. mode |= SDHCI_TRNS_DMA;
  362. writew(mode, host->ioaddr + SDHCI_TRANSFER_MODE);
  363. }
  364. static void sdhci_finish_data(struct sdhci_host *host)
  365. {
  366. struct mmc_data *data;
  367. u16 blocks;
  368. BUG_ON(!host->data);
  369. data = host->data;
  370. host->data = NULL;
  371. if (host->flags & SDHCI_USE_DMA) {
  372. pci_unmap_sg(host->chip->pdev, data->sg, data->sg_len,
  373. (data->flags & MMC_DATA_READ)?PCI_DMA_FROMDEVICE:PCI_DMA_TODEVICE);
  374. }
  375. /*
  376. * Controller doesn't count down when in single block mode.
  377. */
  378. if ((data->blocks == 1) && (data->error == MMC_ERR_NONE))
  379. blocks = 0;
  380. else
  381. blocks = readw(host->ioaddr + SDHCI_BLOCK_COUNT);
  382. data->bytes_xfered = data->blksz * (data->blocks - blocks);
  383. if ((data->error == MMC_ERR_NONE) && blocks) {
  384. printk(KERN_ERR "%s: Controller signalled completion even "
  385. "though there were blocks left. Please report this "
  386. "to " BUGMAIL ".\n", mmc_hostname(host->mmc));
  387. data->error = MMC_ERR_FAILED;
  388. } else if (host->size != 0) {
  389. printk(KERN_ERR "%s: %d bytes were left untransferred. "
  390. "Please report this to " BUGMAIL ".\n",
  391. mmc_hostname(host->mmc), host->size);
  392. data->error = MMC_ERR_FAILED;
  393. }
  394. DBG("Ending data transfer (%d bytes)\n", data->bytes_xfered);
  395. if (data->stop) {
  396. /*
  397. * The controller needs a reset of internal state machines
  398. * upon error conditions.
  399. */
  400. if (data->error != MMC_ERR_NONE) {
  401. sdhci_reset(host, SDHCI_RESET_CMD);
  402. sdhci_reset(host, SDHCI_RESET_DATA);
  403. }
  404. sdhci_send_command(host, data->stop);
  405. } else
  406. tasklet_schedule(&host->finish_tasklet);
  407. }
  408. static void sdhci_send_command(struct sdhci_host *host, struct mmc_command *cmd)
  409. {
  410. int flags;
  411. u32 mask;
  412. unsigned long timeout;
  413. WARN_ON(host->cmd);
  414. DBG("Sending cmd (%x)\n", cmd->opcode);
  415. /* Wait max 10 ms */
  416. timeout = 10;
  417. mask = SDHCI_CMD_INHIBIT;
  418. if ((cmd->data != NULL) || (cmd->flags & MMC_RSP_BUSY))
  419. mask |= SDHCI_DATA_INHIBIT;
  420. /* We shouldn't wait for data inihibit for stop commands, even
  421. though they might use busy signaling */
  422. if (host->mrq->data && (cmd == host->mrq->data->stop))
  423. mask &= ~SDHCI_DATA_INHIBIT;
  424. while (readl(host->ioaddr + SDHCI_PRESENT_STATE) & mask) {
  425. if (timeout == 0) {
  426. printk(KERN_ERR "%s: Controller never released "
  427. "inhibit bit(s). Please report this to "
  428. BUGMAIL ".\n", mmc_hostname(host->mmc));
  429. sdhci_dumpregs(host);
  430. cmd->error = MMC_ERR_FAILED;
  431. tasklet_schedule(&host->finish_tasklet);
  432. return;
  433. }
  434. timeout--;
  435. mdelay(1);
  436. }
  437. mod_timer(&host->timer, jiffies + 10 * HZ);
  438. host->cmd = cmd;
  439. sdhci_prepare_data(host, cmd->data);
  440. writel(cmd->arg, host->ioaddr + SDHCI_ARGUMENT);
  441. sdhci_set_transfer_mode(host, cmd->data);
  442. if ((cmd->flags & MMC_RSP_136) && (cmd->flags & MMC_RSP_BUSY)) {
  443. printk(KERN_ERR "%s: Unsupported response type! "
  444. "Please report this to " BUGMAIL ".\n",
  445. mmc_hostname(host->mmc));
  446. cmd->error = MMC_ERR_INVALID;
  447. tasklet_schedule(&host->finish_tasklet);
  448. return;
  449. }
  450. if (!(cmd->flags & MMC_RSP_PRESENT))
  451. flags = SDHCI_CMD_RESP_NONE;
  452. else if (cmd->flags & MMC_RSP_136)
  453. flags = SDHCI_CMD_RESP_LONG;
  454. else if (cmd->flags & MMC_RSP_BUSY)
  455. flags = SDHCI_CMD_RESP_SHORT_BUSY;
  456. else
  457. flags = SDHCI_CMD_RESP_SHORT;
  458. if (cmd->flags & MMC_RSP_CRC)
  459. flags |= SDHCI_CMD_CRC;
  460. if (cmd->flags & MMC_RSP_OPCODE)
  461. flags |= SDHCI_CMD_INDEX;
  462. if (cmd->data)
  463. flags |= SDHCI_CMD_DATA;
  464. writew(SDHCI_MAKE_CMD(cmd->opcode, flags),
  465. host->ioaddr + SDHCI_COMMAND);
  466. }
  467. static void sdhci_finish_command(struct sdhci_host *host)
  468. {
  469. int i;
  470. BUG_ON(host->cmd == NULL);
  471. if (host->cmd->flags & MMC_RSP_PRESENT) {
  472. if (host->cmd->flags & MMC_RSP_136) {
  473. /* CRC is stripped so we need to do some shifting. */
  474. for (i = 0;i < 4;i++) {
  475. host->cmd->resp[i] = readl(host->ioaddr +
  476. SDHCI_RESPONSE + (3-i)*4) << 8;
  477. if (i != 3)
  478. host->cmd->resp[i] |=
  479. readb(host->ioaddr +
  480. SDHCI_RESPONSE + (3-i)*4-1);
  481. }
  482. } else {
  483. host->cmd->resp[0] = readl(host->ioaddr + SDHCI_RESPONSE);
  484. }
  485. }
  486. host->cmd->error = MMC_ERR_NONE;
  487. DBG("Ending cmd (%x)\n", host->cmd->opcode);
  488. if (host->cmd->data)
  489. host->data = host->cmd->data;
  490. else
  491. tasklet_schedule(&host->finish_tasklet);
  492. host->cmd = NULL;
  493. }
  494. static void sdhci_set_clock(struct sdhci_host *host, unsigned int clock)
  495. {
  496. int div;
  497. u8 ctrl;
  498. u16 clk;
  499. unsigned long timeout;
  500. if (clock == host->clock)
  501. return;
  502. writew(0, host->ioaddr + SDHCI_CLOCK_CONTROL);
  503. ctrl = readb(host->ioaddr + SDHCI_HOST_CONTROL);
  504. if (clock > 25000000)
  505. ctrl |= SDHCI_CTRL_HISPD;
  506. else
  507. ctrl &= ~SDHCI_CTRL_HISPD;
  508. writeb(ctrl, host->ioaddr + SDHCI_HOST_CONTROL);
  509. if (clock == 0)
  510. goto out;
  511. for (div = 1;div < 256;div *= 2) {
  512. if ((host->max_clk / div) <= clock)
  513. break;
  514. }
  515. div >>= 1;
  516. clk = div << SDHCI_DIVIDER_SHIFT;
  517. clk |= SDHCI_CLOCK_INT_EN;
  518. writew(clk, host->ioaddr + SDHCI_CLOCK_CONTROL);
  519. /* Wait max 10 ms */
  520. timeout = 10;
  521. while (!((clk = readw(host->ioaddr + SDHCI_CLOCK_CONTROL))
  522. & SDHCI_CLOCK_INT_STABLE)) {
  523. if (timeout == 0) {
  524. printk(KERN_ERR "%s: Internal clock never stabilised. "
  525. "Please report this to " BUGMAIL ".\n",
  526. mmc_hostname(host->mmc));
  527. sdhci_dumpregs(host);
  528. return;
  529. }
  530. timeout--;
  531. mdelay(1);
  532. }
  533. clk |= SDHCI_CLOCK_CARD_EN;
  534. writew(clk, host->ioaddr + SDHCI_CLOCK_CONTROL);
  535. out:
  536. host->clock = clock;
  537. }
  538. static void sdhci_set_power(struct sdhci_host *host, unsigned short power)
  539. {
  540. u8 pwr;
  541. if (host->power == power)
  542. return;
  543. if (power == (unsigned short)-1) {
  544. writeb(0, host->ioaddr + SDHCI_POWER_CONTROL);
  545. goto out;
  546. }
  547. /*
  548. * Spec says that we should clear the power reg before setting
  549. * a new value. Some controllers don't seem to like this though.
  550. */
  551. if (!(host->chip->quirks & SDHCI_QUIRK_SINGLE_POWER_WRITE))
  552. writeb(0, host->ioaddr + SDHCI_POWER_CONTROL);
  553. pwr = SDHCI_POWER_ON;
  554. switch (power) {
  555. case MMC_VDD_170:
  556. case MMC_VDD_180:
  557. case MMC_VDD_190:
  558. pwr |= SDHCI_POWER_180;
  559. break;
  560. case MMC_VDD_290:
  561. case MMC_VDD_300:
  562. case MMC_VDD_310:
  563. pwr |= SDHCI_POWER_300;
  564. break;
  565. case MMC_VDD_320:
  566. case MMC_VDD_330:
  567. case MMC_VDD_340:
  568. pwr |= SDHCI_POWER_330;
  569. break;
  570. default:
  571. BUG();
  572. }
  573. writeb(pwr, host->ioaddr + SDHCI_POWER_CONTROL);
  574. out:
  575. host->power = power;
  576. }
  577. /*****************************************************************************\
  578. * *
  579. * MMC callbacks *
  580. * *
  581. \*****************************************************************************/
  582. static void sdhci_request(struct mmc_host *mmc, struct mmc_request *mrq)
  583. {
  584. struct sdhci_host *host;
  585. unsigned long flags;
  586. host = mmc_priv(mmc);
  587. spin_lock_irqsave(&host->lock, flags);
  588. WARN_ON(host->mrq != NULL);
  589. sdhci_activate_led(host);
  590. host->mrq = mrq;
  591. if (!(readl(host->ioaddr + SDHCI_PRESENT_STATE) & SDHCI_CARD_PRESENT)) {
  592. host->mrq->cmd->error = MMC_ERR_TIMEOUT;
  593. tasklet_schedule(&host->finish_tasklet);
  594. } else
  595. sdhci_send_command(host, mrq->cmd);
  596. mmiowb();
  597. spin_unlock_irqrestore(&host->lock, flags);
  598. }
  599. static void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
  600. {
  601. struct sdhci_host *host;
  602. unsigned long flags;
  603. u8 ctrl;
  604. host = mmc_priv(mmc);
  605. spin_lock_irqsave(&host->lock, flags);
  606. /*
  607. * Reset the chip on each power off.
  608. * Should clear out any weird states.
  609. */
  610. if (ios->power_mode == MMC_POWER_OFF) {
  611. writel(0, host->ioaddr + SDHCI_SIGNAL_ENABLE);
  612. sdhci_init(host);
  613. }
  614. sdhci_set_clock(host, ios->clock);
  615. if (ios->power_mode == MMC_POWER_OFF)
  616. sdhci_set_power(host, -1);
  617. else
  618. sdhci_set_power(host, ios->vdd);
  619. ctrl = readb(host->ioaddr + SDHCI_HOST_CONTROL);
  620. if (ios->bus_width == MMC_BUS_WIDTH_4)
  621. ctrl |= SDHCI_CTRL_4BITBUS;
  622. else
  623. ctrl &= ~SDHCI_CTRL_4BITBUS;
  624. writeb(ctrl, host->ioaddr + SDHCI_HOST_CONTROL);
  625. mmiowb();
  626. spin_unlock_irqrestore(&host->lock, flags);
  627. }
  628. static int sdhci_get_ro(struct mmc_host *mmc)
  629. {
  630. struct sdhci_host *host;
  631. unsigned long flags;
  632. int present;
  633. host = mmc_priv(mmc);
  634. spin_lock_irqsave(&host->lock, flags);
  635. present = readl(host->ioaddr + SDHCI_PRESENT_STATE);
  636. spin_unlock_irqrestore(&host->lock, flags);
  637. return !(present & SDHCI_WRITE_PROTECT);
  638. }
  639. static const struct mmc_host_ops sdhci_ops = {
  640. .request = sdhci_request,
  641. .set_ios = sdhci_set_ios,
  642. .get_ro = sdhci_get_ro,
  643. };
  644. /*****************************************************************************\
  645. * *
  646. * Tasklets *
  647. * *
  648. \*****************************************************************************/
  649. static void sdhci_tasklet_card(unsigned long param)
  650. {
  651. struct sdhci_host *host;
  652. unsigned long flags;
  653. host = (struct sdhci_host*)param;
  654. spin_lock_irqsave(&host->lock, flags);
  655. if (!(readl(host->ioaddr + SDHCI_PRESENT_STATE) & SDHCI_CARD_PRESENT)) {
  656. if (host->mrq) {
  657. printk(KERN_ERR "%s: Card removed during transfer!\n",
  658. mmc_hostname(host->mmc));
  659. printk(KERN_ERR "%s: Resetting controller.\n",
  660. mmc_hostname(host->mmc));
  661. sdhci_reset(host, SDHCI_RESET_CMD);
  662. sdhci_reset(host, SDHCI_RESET_DATA);
  663. host->mrq->cmd->error = MMC_ERR_FAILED;
  664. tasklet_schedule(&host->finish_tasklet);
  665. }
  666. }
  667. spin_unlock_irqrestore(&host->lock, flags);
  668. mmc_detect_change(host->mmc, msecs_to_jiffies(500));
  669. }
  670. static void sdhci_tasklet_finish(unsigned long param)
  671. {
  672. struct sdhci_host *host;
  673. unsigned long flags;
  674. struct mmc_request *mrq;
  675. host = (struct sdhci_host*)param;
  676. spin_lock_irqsave(&host->lock, flags);
  677. del_timer(&host->timer);
  678. mrq = host->mrq;
  679. DBG("Ending request, cmd (%x)\n", mrq->cmd->opcode);
  680. /*
  681. * The controller needs a reset of internal state machines
  682. * upon error conditions.
  683. */
  684. if ((mrq->cmd->error != MMC_ERR_NONE) ||
  685. (mrq->data && ((mrq->data->error != MMC_ERR_NONE) ||
  686. (mrq->data->stop && (mrq->data->stop->error != MMC_ERR_NONE))))) {
  687. /* Some controllers need this kick or reset won't work here */
  688. if (host->chip->quirks & SDHCI_QUIRK_CLOCK_BEFORE_RESET) {
  689. unsigned int clock;
  690. /* This is to force an update */
  691. clock = host->clock;
  692. host->clock = 0;
  693. sdhci_set_clock(host, clock);
  694. }
  695. /* Spec says we should do both at the same time, but Ricoh
  696. controllers do not like that. */
  697. sdhci_reset(host, SDHCI_RESET_CMD);
  698. sdhci_reset(host, SDHCI_RESET_DATA);
  699. }
  700. host->mrq = NULL;
  701. host->cmd = NULL;
  702. host->data = NULL;
  703. sdhci_deactivate_led(host);
  704. mmiowb();
  705. spin_unlock_irqrestore(&host->lock, flags);
  706. mmc_request_done(host->mmc, mrq);
  707. }
  708. static void sdhci_timeout_timer(unsigned long data)
  709. {
  710. struct sdhci_host *host;
  711. unsigned long flags;
  712. host = (struct sdhci_host*)data;
  713. spin_lock_irqsave(&host->lock, flags);
  714. if (host->mrq) {
  715. printk(KERN_ERR "%s: Timeout waiting for hardware interrupt. "
  716. "Please report this to " BUGMAIL ".\n",
  717. mmc_hostname(host->mmc));
  718. sdhci_dumpregs(host);
  719. if (host->data) {
  720. host->data->error = MMC_ERR_TIMEOUT;
  721. sdhci_finish_data(host);
  722. } else {
  723. if (host->cmd)
  724. host->cmd->error = MMC_ERR_TIMEOUT;
  725. else
  726. host->mrq->cmd->error = MMC_ERR_TIMEOUT;
  727. tasklet_schedule(&host->finish_tasklet);
  728. }
  729. }
  730. mmiowb();
  731. spin_unlock_irqrestore(&host->lock, flags);
  732. }
  733. /*****************************************************************************\
  734. * *
  735. * Interrupt handling *
  736. * *
  737. \*****************************************************************************/
  738. static void sdhci_cmd_irq(struct sdhci_host *host, u32 intmask)
  739. {
  740. BUG_ON(intmask == 0);
  741. if (!host->cmd) {
  742. printk(KERN_ERR "%s: Got command interrupt even though no "
  743. "command operation was in progress.\n",
  744. mmc_hostname(host->mmc));
  745. printk(KERN_ERR "%s: Please report this to " BUGMAIL ".\n",
  746. mmc_hostname(host->mmc));
  747. sdhci_dumpregs(host);
  748. return;
  749. }
  750. if (intmask & SDHCI_INT_RESPONSE)
  751. sdhci_finish_command(host);
  752. else {
  753. if (intmask & SDHCI_INT_TIMEOUT)
  754. host->cmd->error = MMC_ERR_TIMEOUT;
  755. else if (intmask & SDHCI_INT_CRC)
  756. host->cmd->error = MMC_ERR_BADCRC;
  757. else if (intmask & (SDHCI_INT_END_BIT | SDHCI_INT_INDEX))
  758. host->cmd->error = MMC_ERR_FAILED;
  759. else
  760. host->cmd->error = MMC_ERR_INVALID;
  761. tasklet_schedule(&host->finish_tasklet);
  762. }
  763. }
  764. static void sdhci_data_irq(struct sdhci_host *host, u32 intmask)
  765. {
  766. BUG_ON(intmask == 0);
  767. if (!host->data) {
  768. /*
  769. * A data end interrupt is sent together with the response
  770. * for the stop command.
  771. */
  772. if (intmask & SDHCI_INT_DATA_END)
  773. return;
  774. printk(KERN_ERR "%s: Got data interrupt even though no "
  775. "data operation was in progress.\n",
  776. mmc_hostname(host->mmc));
  777. printk(KERN_ERR "%s: Please report this to " BUGMAIL ".\n",
  778. mmc_hostname(host->mmc));
  779. sdhci_dumpregs(host);
  780. return;
  781. }
  782. if (intmask & SDHCI_INT_DATA_TIMEOUT)
  783. host->data->error = MMC_ERR_TIMEOUT;
  784. else if (intmask & SDHCI_INT_DATA_CRC)
  785. host->data->error = MMC_ERR_BADCRC;
  786. else if (intmask & SDHCI_INT_DATA_END_BIT)
  787. host->data->error = MMC_ERR_FAILED;
  788. if (host->data->error != MMC_ERR_NONE)
  789. sdhci_finish_data(host);
  790. else {
  791. if (intmask & (SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL))
  792. sdhci_transfer_pio(host);
  793. if (intmask & SDHCI_INT_DATA_END)
  794. sdhci_finish_data(host);
  795. }
  796. }
  797. static irqreturn_t sdhci_irq(int irq, void *dev_id)
  798. {
  799. irqreturn_t result;
  800. struct sdhci_host* host = dev_id;
  801. u32 intmask;
  802. spin_lock(&host->lock);
  803. intmask = readl(host->ioaddr + SDHCI_INT_STATUS);
  804. if (!intmask) {
  805. result = IRQ_NONE;
  806. goto out;
  807. }
  808. DBG("*** %s got interrupt: 0x%08x\n", host->slot_descr, intmask);
  809. if (intmask & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) {
  810. writel(intmask & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE),
  811. host->ioaddr + SDHCI_INT_STATUS);
  812. tasklet_schedule(&host->card_tasklet);
  813. }
  814. intmask &= ~(SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE);
  815. if (intmask & SDHCI_INT_CMD_MASK) {
  816. writel(intmask & SDHCI_INT_CMD_MASK,
  817. host->ioaddr + SDHCI_INT_STATUS);
  818. sdhci_cmd_irq(host, intmask & SDHCI_INT_CMD_MASK);
  819. }
  820. if (intmask & SDHCI_INT_DATA_MASK) {
  821. writel(intmask & SDHCI_INT_DATA_MASK,
  822. host->ioaddr + SDHCI_INT_STATUS);
  823. sdhci_data_irq(host, intmask & SDHCI_INT_DATA_MASK);
  824. }
  825. intmask &= ~(SDHCI_INT_CMD_MASK | SDHCI_INT_DATA_MASK);
  826. if (intmask & SDHCI_INT_BUS_POWER) {
  827. printk(KERN_ERR "%s: Card is consuming too much power!\n",
  828. mmc_hostname(host->mmc));
  829. writel(SDHCI_INT_BUS_POWER, host->ioaddr + SDHCI_INT_STATUS);
  830. }
  831. intmask &= SDHCI_INT_BUS_POWER;
  832. if (intmask) {
  833. printk(KERN_ERR "%s: Unexpected interrupt 0x%08x. Please "
  834. "report this to " BUGMAIL ".\n",
  835. mmc_hostname(host->mmc), intmask);
  836. sdhci_dumpregs(host);
  837. writel(intmask, host->ioaddr + SDHCI_INT_STATUS);
  838. }
  839. result = IRQ_HANDLED;
  840. mmiowb();
  841. out:
  842. spin_unlock(&host->lock);
  843. return result;
  844. }
  845. /*****************************************************************************\
  846. * *
  847. * Suspend/resume *
  848. * *
  849. \*****************************************************************************/
  850. #ifdef CONFIG_PM
  851. static int sdhci_suspend (struct pci_dev *pdev, pm_message_t state)
  852. {
  853. struct sdhci_chip *chip;
  854. int i, ret;
  855. chip = pci_get_drvdata(pdev);
  856. if (!chip)
  857. return 0;
  858. DBG("Suspending...\n");
  859. for (i = 0;i < chip->num_slots;i++) {
  860. if (!chip->hosts[i])
  861. continue;
  862. ret = mmc_suspend_host(chip->hosts[i]->mmc, state);
  863. if (ret) {
  864. for (i--;i >= 0;i--)
  865. mmc_resume_host(chip->hosts[i]->mmc);
  866. return ret;
  867. }
  868. }
  869. pci_save_state(pdev);
  870. pci_enable_wake(pdev, pci_choose_state(pdev, state), 0);
  871. pci_disable_device(pdev);
  872. pci_set_power_state(pdev, pci_choose_state(pdev, state));
  873. return 0;
  874. }
  875. static int sdhci_resume (struct pci_dev *pdev)
  876. {
  877. struct sdhci_chip *chip;
  878. int i, ret;
  879. chip = pci_get_drvdata(pdev);
  880. if (!chip)
  881. return 0;
  882. DBG("Resuming...\n");
  883. pci_set_power_state(pdev, PCI_D0);
  884. pci_restore_state(pdev);
  885. ret = pci_enable_device(pdev);
  886. if (ret)
  887. return ret;
  888. for (i = 0;i < chip->num_slots;i++) {
  889. if (!chip->hosts[i])
  890. continue;
  891. if (chip->hosts[i]->flags & SDHCI_USE_DMA)
  892. pci_set_master(pdev);
  893. sdhci_init(chip->hosts[i]);
  894. mmiowb();
  895. ret = mmc_resume_host(chip->hosts[i]->mmc);
  896. if (ret)
  897. return ret;
  898. }
  899. return 0;
  900. }
  901. #else /* CONFIG_PM */
  902. #define sdhci_suspend NULL
  903. #define sdhci_resume NULL
  904. #endif /* CONFIG_PM */
  905. /*****************************************************************************\
  906. * *
  907. * Device probing/removal *
  908. * *
  909. \*****************************************************************************/
  910. static int __devinit sdhci_probe_slot(struct pci_dev *pdev, int slot)
  911. {
  912. int ret;
  913. unsigned int version;
  914. struct sdhci_chip *chip;
  915. struct mmc_host *mmc;
  916. struct sdhci_host *host;
  917. u8 first_bar;
  918. unsigned int caps;
  919. chip = pci_get_drvdata(pdev);
  920. BUG_ON(!chip);
  921. ret = pci_read_config_byte(pdev, PCI_SLOT_INFO, &first_bar);
  922. if (ret)
  923. return ret;
  924. first_bar &= PCI_SLOT_INFO_FIRST_BAR_MASK;
  925. if (first_bar > 5) {
  926. printk(KERN_ERR DRIVER_NAME ": Invalid first BAR. Aborting.\n");
  927. return -ENODEV;
  928. }
  929. if (!(pci_resource_flags(pdev, first_bar + slot) & IORESOURCE_MEM)) {
  930. printk(KERN_ERR DRIVER_NAME ": BAR is not iomem. Aborting.\n");
  931. return -ENODEV;
  932. }
  933. if (pci_resource_len(pdev, first_bar + slot) != 0x100) {
  934. printk(KERN_ERR DRIVER_NAME ": Invalid iomem size. "
  935. "You may experience problems.\n");
  936. }
  937. if ((pdev->class & 0x0000FF) == PCI_SDHCI_IFVENDOR) {
  938. printk(KERN_ERR DRIVER_NAME ": Vendor specific interface. Aborting.\n");
  939. return -ENODEV;
  940. }
  941. if ((pdev->class & 0x0000FF) > PCI_SDHCI_IFVENDOR) {
  942. printk(KERN_ERR DRIVER_NAME ": Unknown interface. Aborting.\n");
  943. return -ENODEV;
  944. }
  945. mmc = mmc_alloc_host(sizeof(struct sdhci_host), &pdev->dev);
  946. if (!mmc)
  947. return -ENOMEM;
  948. host = mmc_priv(mmc);
  949. host->mmc = mmc;
  950. host->chip = chip;
  951. chip->hosts[slot] = host;
  952. host->bar = first_bar + slot;
  953. host->addr = pci_resource_start(pdev, host->bar);
  954. host->irq = pdev->irq;
  955. DBG("slot %d at 0x%08lx, irq %d\n", slot, host->addr, host->irq);
  956. snprintf(host->slot_descr, 20, "sdhci:slot%d", slot);
  957. ret = pci_request_region(pdev, host->bar, host->slot_descr);
  958. if (ret)
  959. goto free;
  960. host->ioaddr = ioremap_nocache(host->addr,
  961. pci_resource_len(pdev, host->bar));
  962. if (!host->ioaddr) {
  963. ret = -ENOMEM;
  964. goto release;
  965. }
  966. sdhci_reset(host, SDHCI_RESET_ALL);
  967. version = readw(host->ioaddr + SDHCI_HOST_VERSION);
  968. version = (version & SDHCI_SPEC_VER_MASK) >> SDHCI_SPEC_VER_SHIFT;
  969. if (version != 0) {
  970. printk(KERN_ERR "%s: Unknown controller version (%d). "
  971. "You may experience problems.\n", host->slot_descr,
  972. version);
  973. }
  974. caps = readl(host->ioaddr + SDHCI_CAPABILITIES);
  975. if (debug_nodma)
  976. DBG("DMA forced off\n");
  977. else if (debug_forcedma) {
  978. DBG("DMA forced on\n");
  979. host->flags |= SDHCI_USE_DMA;
  980. } else if (chip->quirks & SDHCI_QUIRK_FORCE_DMA)
  981. host->flags |= SDHCI_USE_DMA;
  982. else if ((pdev->class & 0x0000FF) != PCI_SDHCI_IFDMA)
  983. DBG("Controller doesn't have DMA interface\n");
  984. else if (!(caps & SDHCI_CAN_DO_DMA))
  985. DBG("Controller doesn't have DMA capability\n");
  986. else
  987. host->flags |= SDHCI_USE_DMA;
  988. if (host->flags & SDHCI_USE_DMA) {
  989. if (pci_set_dma_mask(pdev, DMA_32BIT_MASK)) {
  990. printk(KERN_WARNING "%s: No suitable DMA available. "
  991. "Falling back to PIO.\n", host->slot_descr);
  992. host->flags &= ~SDHCI_USE_DMA;
  993. }
  994. }
  995. if (host->flags & SDHCI_USE_DMA)
  996. pci_set_master(pdev);
  997. else /* XXX: Hack to get MMC layer to avoid highmem */
  998. pdev->dma_mask = 0;
  999. host->max_clk =
  1000. (caps & SDHCI_CLOCK_BASE_MASK) >> SDHCI_CLOCK_BASE_SHIFT;
  1001. if (host->max_clk == 0) {
  1002. printk(KERN_ERR "%s: Hardware doesn't specify base clock "
  1003. "frequency.\n", host->slot_descr);
  1004. ret = -ENODEV;
  1005. goto unmap;
  1006. }
  1007. host->max_clk *= 1000000;
  1008. host->timeout_clk =
  1009. (caps & SDHCI_TIMEOUT_CLK_MASK) >> SDHCI_TIMEOUT_CLK_SHIFT;
  1010. if (host->timeout_clk == 0) {
  1011. printk(KERN_ERR "%s: Hardware doesn't specify timeout clock "
  1012. "frequency.\n", host->slot_descr);
  1013. ret = -ENODEV;
  1014. goto unmap;
  1015. }
  1016. if (caps & SDHCI_TIMEOUT_CLK_UNIT)
  1017. host->timeout_clk *= 1000;
  1018. /*
  1019. * Set host parameters.
  1020. */
  1021. mmc->ops = &sdhci_ops;
  1022. mmc->f_min = host->max_clk / 256;
  1023. mmc->f_max = host->max_clk;
  1024. mmc->caps = MMC_CAP_4_BIT_DATA | MMC_CAP_MULTIWRITE | MMC_CAP_BYTEBLOCK;
  1025. mmc->ocr_avail = 0;
  1026. if (caps & SDHCI_CAN_VDD_330)
  1027. mmc->ocr_avail |= MMC_VDD_32_33|MMC_VDD_33_34;
  1028. if (caps & SDHCI_CAN_VDD_300)
  1029. mmc->ocr_avail |= MMC_VDD_29_30|MMC_VDD_30_31;
  1030. if (caps & SDHCI_CAN_VDD_180)
  1031. mmc->ocr_avail |= MMC_VDD_17_18|MMC_VDD_18_19;
  1032. if ((host->max_clk > 25000000) && !(caps & SDHCI_CAN_DO_HISPD)) {
  1033. printk(KERN_ERR "%s: Controller reports > 25 MHz base clock,"
  1034. " but no high speed support.\n",
  1035. host->slot_descr);
  1036. mmc->f_max = 25000000;
  1037. }
  1038. if (mmc->ocr_avail == 0) {
  1039. printk(KERN_ERR "%s: Hardware doesn't report any "
  1040. "support voltages.\n", host->slot_descr);
  1041. ret = -ENODEV;
  1042. goto unmap;
  1043. }
  1044. spin_lock_init(&host->lock);
  1045. /*
  1046. * Maximum number of segments. Hardware cannot do scatter lists.
  1047. */
  1048. if (host->flags & SDHCI_USE_DMA)
  1049. mmc->max_hw_segs = 1;
  1050. else
  1051. mmc->max_hw_segs = 16;
  1052. mmc->max_phys_segs = 16;
  1053. /*
  1054. * Maximum number of sectors in one transfer. Limited by DMA boundary
  1055. * size (512KiB).
  1056. */
  1057. mmc->max_req_size = 524288;
  1058. /*
  1059. * Maximum segment size. Could be one segment with the maximum number
  1060. * of bytes.
  1061. */
  1062. mmc->max_seg_size = mmc->max_req_size;
  1063. /*
  1064. * Maximum block size. This varies from controller to controller and
  1065. * is specified in the capabilities register.
  1066. */
  1067. mmc->max_blk_size = (caps & SDHCI_MAX_BLOCK_MASK) >> SDHCI_MAX_BLOCK_SHIFT;
  1068. if (mmc->max_blk_size >= 3) {
  1069. printk(KERN_ERR "%s: Invalid maximum block size.\n",
  1070. host->slot_descr);
  1071. ret = -ENODEV;
  1072. goto unmap;
  1073. }
  1074. mmc->max_blk_size = 512 << mmc->max_blk_size;
  1075. /*
  1076. * Maximum block count.
  1077. */
  1078. mmc->max_blk_count = 65535;
  1079. /*
  1080. * Init tasklets.
  1081. */
  1082. tasklet_init(&host->card_tasklet,
  1083. sdhci_tasklet_card, (unsigned long)host);
  1084. tasklet_init(&host->finish_tasklet,
  1085. sdhci_tasklet_finish, (unsigned long)host);
  1086. setup_timer(&host->timer, sdhci_timeout_timer, (unsigned long)host);
  1087. ret = request_irq(host->irq, sdhci_irq, IRQF_SHARED,
  1088. host->slot_descr, host);
  1089. if (ret)
  1090. goto untasklet;
  1091. sdhci_init(host);
  1092. #ifdef CONFIG_MMC_DEBUG
  1093. sdhci_dumpregs(host);
  1094. #endif
  1095. mmiowb();
  1096. mmc_add_host(mmc);
  1097. printk(KERN_INFO "%s: SDHCI at 0x%08lx irq %d %s\n", mmc_hostname(mmc),
  1098. host->addr, host->irq,
  1099. (host->flags & SDHCI_USE_DMA)?"DMA":"PIO");
  1100. return 0;
  1101. untasklet:
  1102. tasklet_kill(&host->card_tasklet);
  1103. tasklet_kill(&host->finish_tasklet);
  1104. unmap:
  1105. iounmap(host->ioaddr);
  1106. release:
  1107. pci_release_region(pdev, host->bar);
  1108. free:
  1109. mmc_free_host(mmc);
  1110. return ret;
  1111. }
  1112. static void sdhci_remove_slot(struct pci_dev *pdev, int slot)
  1113. {
  1114. struct sdhci_chip *chip;
  1115. struct mmc_host *mmc;
  1116. struct sdhci_host *host;
  1117. chip = pci_get_drvdata(pdev);
  1118. host = chip->hosts[slot];
  1119. mmc = host->mmc;
  1120. chip->hosts[slot] = NULL;
  1121. mmc_remove_host(mmc);
  1122. sdhci_reset(host, SDHCI_RESET_ALL);
  1123. free_irq(host->irq, host);
  1124. del_timer_sync(&host->timer);
  1125. tasklet_kill(&host->card_tasklet);
  1126. tasklet_kill(&host->finish_tasklet);
  1127. iounmap(host->ioaddr);
  1128. pci_release_region(pdev, host->bar);
  1129. mmc_free_host(mmc);
  1130. }
  1131. static int __devinit sdhci_probe(struct pci_dev *pdev,
  1132. const struct pci_device_id *ent)
  1133. {
  1134. int ret, i;
  1135. u8 slots, rev;
  1136. struct sdhci_chip *chip;
  1137. BUG_ON(pdev == NULL);
  1138. BUG_ON(ent == NULL);
  1139. pci_read_config_byte(pdev, PCI_CLASS_REVISION, &rev);
  1140. printk(KERN_INFO DRIVER_NAME
  1141. ": SDHCI controller found at %s [%04x:%04x] (rev %x)\n",
  1142. pci_name(pdev), (int)pdev->vendor, (int)pdev->device,
  1143. (int)rev);
  1144. ret = pci_read_config_byte(pdev, PCI_SLOT_INFO, &slots);
  1145. if (ret)
  1146. return ret;
  1147. slots = PCI_SLOT_INFO_SLOTS(slots) + 1;
  1148. DBG("found %d slot(s)\n", slots);
  1149. if (slots == 0)
  1150. return -ENODEV;
  1151. ret = pci_enable_device(pdev);
  1152. if (ret)
  1153. return ret;
  1154. chip = kzalloc(sizeof(struct sdhci_chip) +
  1155. sizeof(struct sdhci_host*) * slots, GFP_KERNEL);
  1156. if (!chip) {
  1157. ret = -ENOMEM;
  1158. goto err;
  1159. }
  1160. chip->pdev = pdev;
  1161. chip->quirks = ent->driver_data;
  1162. if (debug_quirks)
  1163. chip->quirks = debug_quirks;
  1164. chip->num_slots = slots;
  1165. pci_set_drvdata(pdev, chip);
  1166. for (i = 0;i < slots;i++) {
  1167. ret = sdhci_probe_slot(pdev, i);
  1168. if (ret) {
  1169. for (i--;i >= 0;i--)
  1170. sdhci_remove_slot(pdev, i);
  1171. goto free;
  1172. }
  1173. }
  1174. return 0;
  1175. free:
  1176. pci_set_drvdata(pdev, NULL);
  1177. kfree(chip);
  1178. err:
  1179. pci_disable_device(pdev);
  1180. return ret;
  1181. }
  1182. static void __devexit sdhci_remove(struct pci_dev *pdev)
  1183. {
  1184. int i;
  1185. struct sdhci_chip *chip;
  1186. chip = pci_get_drvdata(pdev);
  1187. if (chip) {
  1188. for (i = 0;i < chip->num_slots;i++)
  1189. sdhci_remove_slot(pdev, i);
  1190. pci_set_drvdata(pdev, NULL);
  1191. kfree(chip);
  1192. }
  1193. pci_disable_device(pdev);
  1194. }
  1195. static struct pci_driver sdhci_driver = {
  1196. .name = DRIVER_NAME,
  1197. .id_table = pci_ids,
  1198. .probe = sdhci_probe,
  1199. .remove = __devexit_p(sdhci_remove),
  1200. .suspend = sdhci_suspend,
  1201. .resume = sdhci_resume,
  1202. };
  1203. /*****************************************************************************\
  1204. * *
  1205. * Driver init/exit *
  1206. * *
  1207. \*****************************************************************************/
  1208. static int __init sdhci_drv_init(void)
  1209. {
  1210. printk(KERN_INFO DRIVER_NAME
  1211. ": Secure Digital Host Controller Interface driver\n");
  1212. printk(KERN_INFO DRIVER_NAME ": Copyright(c) Pierre Ossman\n");
  1213. return pci_register_driver(&sdhci_driver);
  1214. }
  1215. static void __exit sdhci_drv_exit(void)
  1216. {
  1217. DBG("Exiting\n");
  1218. pci_unregister_driver(&sdhci_driver);
  1219. }
  1220. module_init(sdhci_drv_init);
  1221. module_exit(sdhci_drv_exit);
  1222. module_param(debug_nodma, uint, 0444);
  1223. module_param(debug_forcedma, uint, 0444);
  1224. module_param(debug_quirks, uint, 0444);
  1225. MODULE_AUTHOR("Pierre Ossman <drzeus@drzeus.cx>");
  1226. MODULE_DESCRIPTION("Secure Digital Host Controller Interface driver");
  1227. MODULE_LICENSE("GPL");
  1228. MODULE_PARM_DESC(debug_nodma, "Forcefully disable DMA transfers. (default 0)");
  1229. MODULE_PARM_DESC(debug_forcedma, "Forcefully enable DMA transfers. (default 0)");
  1230. MODULE_PARM_DESC(debug_quirks, "Force certain quirks.");