sdhci.c 37 KB

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