sdhci.c 38 KB

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