sdhci.c 38 KB

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