sdhci.c 38 KB

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