mmc.c 37 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621
  1. /*
  2. * linux/drivers/mmc/mmc.c
  3. *
  4. * Copyright (C) 2003-2004 Russell King, All Rights Reserved.
  5. * SD support Copyright (C) 2004 Ian Molton, All Rights Reserved.
  6. * SD support Copyright (C) 2005 Pierre Ossman, All Rights Reserved.
  7. * MMCv4 support Copyright (C) 2006 Philip Langdale, All Rights Reserved.
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License version 2 as
  11. * published by the Free Software Foundation.
  12. */
  13. #include <linux/module.h>
  14. #include <linux/init.h>
  15. #include <linux/interrupt.h>
  16. #include <linux/completion.h>
  17. #include <linux/device.h>
  18. #include <linux/delay.h>
  19. #include <linux/pagemap.h>
  20. #include <linux/err.h>
  21. #include <asm/scatterlist.h>
  22. #include <linux/scatterlist.h>
  23. #include <linux/mmc/card.h>
  24. #include <linux/mmc/host.h>
  25. #include <linux/mmc/protocol.h>
  26. #include "mmc.h"
  27. #define CMD_RETRIES 3
  28. /*
  29. * OCR Bit positions to 10s of Vdd mV.
  30. */
  31. static const unsigned short mmc_ocr_bit_to_vdd[] = {
  32. 150, 155, 160, 165, 170, 180, 190, 200,
  33. 210, 220, 230, 240, 250, 260, 270, 280,
  34. 290, 300, 310, 320, 330, 340, 350, 360
  35. };
  36. static const unsigned int tran_exp[] = {
  37. 10000, 100000, 1000000, 10000000,
  38. 0, 0, 0, 0
  39. };
  40. static const unsigned char tran_mant[] = {
  41. 0, 10, 12, 13, 15, 20, 25, 30,
  42. 35, 40, 45, 50, 55, 60, 70, 80,
  43. };
  44. static const unsigned int tacc_exp[] = {
  45. 1, 10, 100, 1000, 10000, 100000, 1000000, 10000000,
  46. };
  47. static const unsigned int tacc_mant[] = {
  48. 0, 10, 12, 13, 15, 20, 25, 30,
  49. 35, 40, 45, 50, 55, 60, 70, 80,
  50. };
  51. /**
  52. * mmc_request_done - finish processing an MMC request
  53. * @host: MMC host which completed request
  54. * @mrq: MMC request which request
  55. *
  56. * MMC drivers should call this function when they have completed
  57. * their processing of a request.
  58. */
  59. void mmc_request_done(struct mmc_host *host, struct mmc_request *mrq)
  60. {
  61. struct mmc_command *cmd = mrq->cmd;
  62. int err = cmd->error;
  63. pr_debug("%s: req done (CMD%u): %d/%d/%d: %08x %08x %08x %08x\n",
  64. mmc_hostname(host), cmd->opcode, err,
  65. mrq->data ? mrq->data->error : 0,
  66. mrq->stop ? mrq->stop->error : 0,
  67. cmd->resp[0], cmd->resp[1], cmd->resp[2], cmd->resp[3]);
  68. if (err && cmd->retries) {
  69. cmd->retries--;
  70. cmd->error = 0;
  71. host->ops->request(host, mrq);
  72. } else if (mrq->done) {
  73. mrq->done(mrq);
  74. }
  75. }
  76. EXPORT_SYMBOL(mmc_request_done);
  77. /**
  78. * mmc_start_request - start a command on a host
  79. * @host: MMC host to start command on
  80. * @mrq: MMC request to start
  81. *
  82. * Queue a command on the specified host. We expect the
  83. * caller to be holding the host lock with interrupts disabled.
  84. */
  85. void
  86. mmc_start_request(struct mmc_host *host, struct mmc_request *mrq)
  87. {
  88. pr_debug("%s: starting CMD%u arg %08x flags %08x\n",
  89. mmc_hostname(host), mrq->cmd->opcode,
  90. mrq->cmd->arg, mrq->cmd->flags);
  91. WARN_ON(host->card_busy == NULL);
  92. mrq->cmd->error = 0;
  93. mrq->cmd->mrq = mrq;
  94. if (mrq->data) {
  95. mrq->cmd->data = mrq->data;
  96. mrq->data->error = 0;
  97. mrq->data->mrq = mrq;
  98. if (mrq->stop) {
  99. mrq->data->stop = mrq->stop;
  100. mrq->stop->error = 0;
  101. mrq->stop->mrq = mrq;
  102. }
  103. }
  104. host->ops->request(host, mrq);
  105. }
  106. EXPORT_SYMBOL(mmc_start_request);
  107. static void mmc_wait_done(struct mmc_request *mrq)
  108. {
  109. complete(mrq->done_data);
  110. }
  111. int mmc_wait_for_req(struct mmc_host *host, struct mmc_request *mrq)
  112. {
  113. DECLARE_COMPLETION_ONSTACK(complete);
  114. mrq->done_data = &complete;
  115. mrq->done = mmc_wait_done;
  116. mmc_start_request(host, mrq);
  117. wait_for_completion(&complete);
  118. return 0;
  119. }
  120. EXPORT_SYMBOL(mmc_wait_for_req);
  121. /**
  122. * mmc_wait_for_cmd - start a command and wait for completion
  123. * @host: MMC host to start command
  124. * @cmd: MMC command to start
  125. * @retries: maximum number of retries
  126. *
  127. * Start a new MMC command for a host, and wait for the command
  128. * to complete. Return any error that occurred while the command
  129. * was executing. Do not attempt to parse the response.
  130. */
  131. int mmc_wait_for_cmd(struct mmc_host *host, struct mmc_command *cmd, int retries)
  132. {
  133. struct mmc_request mrq;
  134. BUG_ON(host->card_busy == NULL);
  135. memset(&mrq, 0, sizeof(struct mmc_request));
  136. memset(cmd->resp, 0, sizeof(cmd->resp));
  137. cmd->retries = retries;
  138. mrq.cmd = cmd;
  139. cmd->data = NULL;
  140. mmc_wait_for_req(host, &mrq);
  141. return cmd->error;
  142. }
  143. EXPORT_SYMBOL(mmc_wait_for_cmd);
  144. /**
  145. * mmc_wait_for_app_cmd - start an application command and wait for
  146. completion
  147. * @host: MMC host to start command
  148. * @rca: RCA to send MMC_APP_CMD to
  149. * @cmd: MMC command to start
  150. * @retries: maximum number of retries
  151. *
  152. * Sends a MMC_APP_CMD, checks the card response, sends the command
  153. * in the parameter and waits for it to complete. Return any error
  154. * that occurred while the command was executing. Do not attempt to
  155. * parse the response.
  156. */
  157. int mmc_wait_for_app_cmd(struct mmc_host *host, unsigned int rca,
  158. struct mmc_command *cmd, int retries)
  159. {
  160. struct mmc_request mrq;
  161. struct mmc_command appcmd;
  162. int i, err;
  163. BUG_ON(host->card_busy == NULL);
  164. BUG_ON(retries < 0);
  165. err = MMC_ERR_INVALID;
  166. /*
  167. * We have to resend MMC_APP_CMD for each attempt so
  168. * we cannot use the retries field in mmc_command.
  169. */
  170. for (i = 0;i <= retries;i++) {
  171. memset(&mrq, 0, sizeof(struct mmc_request));
  172. appcmd.opcode = MMC_APP_CMD;
  173. appcmd.arg = rca << 16;
  174. appcmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
  175. appcmd.retries = 0;
  176. memset(appcmd.resp, 0, sizeof(appcmd.resp));
  177. appcmd.data = NULL;
  178. mrq.cmd = &appcmd;
  179. appcmd.data = NULL;
  180. mmc_wait_for_req(host, &mrq);
  181. if (appcmd.error) {
  182. err = appcmd.error;
  183. continue;
  184. }
  185. /* Check that card supported application commands */
  186. if (!(appcmd.resp[0] & R1_APP_CMD))
  187. return MMC_ERR_FAILED;
  188. memset(&mrq, 0, sizeof(struct mmc_request));
  189. memset(cmd->resp, 0, sizeof(cmd->resp));
  190. cmd->retries = 0;
  191. mrq.cmd = cmd;
  192. cmd->data = NULL;
  193. mmc_wait_for_req(host, &mrq);
  194. err = cmd->error;
  195. if (cmd->error == MMC_ERR_NONE)
  196. break;
  197. }
  198. return err;
  199. }
  200. EXPORT_SYMBOL(mmc_wait_for_app_cmd);
  201. /**
  202. * mmc_set_data_timeout - set the timeout for a data command
  203. * @data: data phase for command
  204. * @card: the MMC card associated with the data transfer
  205. * @write: flag to differentiate reads from writes
  206. */
  207. void mmc_set_data_timeout(struct mmc_data *data, const struct mmc_card *card,
  208. int write)
  209. {
  210. unsigned int mult;
  211. /*
  212. * SD cards use a 100 multiplier rather than 10
  213. */
  214. mult = mmc_card_sd(card) ? 100 : 10;
  215. /*
  216. * Scale up the multiplier (and therefore the timeout) by
  217. * the r2w factor for writes.
  218. */
  219. if (write)
  220. mult <<= card->csd.r2w_factor;
  221. data->timeout_ns = card->csd.tacc_ns * mult;
  222. data->timeout_clks = card->csd.tacc_clks * mult;
  223. /*
  224. * SD cards also have an upper limit on the timeout.
  225. */
  226. if (mmc_card_sd(card)) {
  227. unsigned int timeout_us, limit_us;
  228. timeout_us = data->timeout_ns / 1000;
  229. timeout_us += data->timeout_clks * 1000 /
  230. (card->host->ios.clock / 1000);
  231. if (write)
  232. limit_us = 250000;
  233. else
  234. limit_us = 100000;
  235. if (timeout_us > limit_us) {
  236. data->timeout_ns = limit_us * 1000;
  237. data->timeout_clks = 0;
  238. }
  239. }
  240. }
  241. EXPORT_SYMBOL(mmc_set_data_timeout);
  242. static int mmc_select_card(struct mmc_host *host, struct mmc_card *card);
  243. /**
  244. * __mmc_claim_host - exclusively claim a host
  245. * @host: mmc host to claim
  246. * @card: mmc card to claim host for
  247. *
  248. * Claim a host for a set of operations. If a valid card
  249. * is passed and this wasn't the last card selected, select
  250. * the card before returning.
  251. *
  252. * Note: you should use mmc_card_claim_host or mmc_claim_host.
  253. */
  254. int __mmc_claim_host(struct mmc_host *host, struct mmc_card *card)
  255. {
  256. DECLARE_WAITQUEUE(wait, current);
  257. unsigned long flags;
  258. int err = 0;
  259. add_wait_queue(&host->wq, &wait);
  260. spin_lock_irqsave(&host->lock, flags);
  261. while (1) {
  262. set_current_state(TASK_UNINTERRUPTIBLE);
  263. if (host->card_busy == NULL)
  264. break;
  265. spin_unlock_irqrestore(&host->lock, flags);
  266. schedule();
  267. spin_lock_irqsave(&host->lock, flags);
  268. }
  269. set_current_state(TASK_RUNNING);
  270. host->card_busy = card;
  271. spin_unlock_irqrestore(&host->lock, flags);
  272. remove_wait_queue(&host->wq, &wait);
  273. if (card != (void *)-1) {
  274. err = mmc_select_card(host, card);
  275. if (err != MMC_ERR_NONE)
  276. return err;
  277. }
  278. return err;
  279. }
  280. EXPORT_SYMBOL(__mmc_claim_host);
  281. /**
  282. * mmc_release_host - release a host
  283. * @host: mmc host to release
  284. *
  285. * Release a MMC host, allowing others to claim the host
  286. * for their operations.
  287. */
  288. void mmc_release_host(struct mmc_host *host)
  289. {
  290. unsigned long flags;
  291. BUG_ON(host->card_busy == NULL);
  292. spin_lock_irqsave(&host->lock, flags);
  293. host->card_busy = NULL;
  294. spin_unlock_irqrestore(&host->lock, flags);
  295. wake_up(&host->wq);
  296. }
  297. EXPORT_SYMBOL(mmc_release_host);
  298. static inline void mmc_set_ios(struct mmc_host *host)
  299. {
  300. struct mmc_ios *ios = &host->ios;
  301. pr_debug("%s: clock %uHz busmode %u powermode %u cs %u Vdd %u width %u\n",
  302. mmc_hostname(host), ios->clock, ios->bus_mode,
  303. ios->power_mode, ios->chip_select, ios->vdd,
  304. ios->bus_width);
  305. host->ops->set_ios(host, ios);
  306. }
  307. static int mmc_select_card(struct mmc_host *host, struct mmc_card *card)
  308. {
  309. int err;
  310. struct mmc_command cmd;
  311. BUG_ON(host->card_busy == NULL);
  312. if (host->card_selected == card)
  313. return MMC_ERR_NONE;
  314. host->card_selected = card;
  315. cmd.opcode = MMC_SELECT_CARD;
  316. cmd.arg = card->rca << 16;
  317. cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
  318. err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
  319. if (err != MMC_ERR_NONE)
  320. return err;
  321. /*
  322. * We can only change the bus width of SD cards when
  323. * they are selected so we have to put the handling
  324. * here.
  325. *
  326. * The card is in 1 bit mode by default so
  327. * we only need to change if it supports the
  328. * wider version.
  329. */
  330. if (mmc_card_sd(card) &&
  331. (card->scr.bus_widths & SD_SCR_BUS_WIDTH_4)) {
  332. /*
  333. * Default bus width is 1 bit.
  334. */
  335. host->ios.bus_width = MMC_BUS_WIDTH_1;
  336. if (host->caps & MMC_CAP_4_BIT_DATA) {
  337. struct mmc_command cmd;
  338. cmd.opcode = SD_APP_SET_BUS_WIDTH;
  339. cmd.arg = SD_BUS_WIDTH_4;
  340. cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
  341. err = mmc_wait_for_app_cmd(host, card->rca, &cmd,
  342. CMD_RETRIES);
  343. if (err != MMC_ERR_NONE)
  344. return err;
  345. host->ios.bus_width = MMC_BUS_WIDTH_4;
  346. }
  347. }
  348. mmc_set_ios(host);
  349. return MMC_ERR_NONE;
  350. }
  351. /*
  352. * Ensure that no card is selected.
  353. */
  354. static void mmc_deselect_cards(struct mmc_host *host)
  355. {
  356. struct mmc_command cmd;
  357. if (host->card_selected) {
  358. host->card_selected = NULL;
  359. cmd.opcode = MMC_SELECT_CARD;
  360. cmd.arg = 0;
  361. cmd.flags = MMC_RSP_NONE | MMC_CMD_AC;
  362. mmc_wait_for_cmd(host, &cmd, 0);
  363. }
  364. }
  365. static inline void mmc_delay(unsigned int ms)
  366. {
  367. if (ms < 1000 / HZ) {
  368. cond_resched();
  369. mdelay(ms);
  370. } else {
  371. msleep(ms);
  372. }
  373. }
  374. /*
  375. * Mask off any voltages we don't support and select
  376. * the lowest voltage
  377. */
  378. static u32 mmc_select_voltage(struct mmc_host *host, u32 ocr)
  379. {
  380. int bit;
  381. ocr &= host->ocr_avail;
  382. bit = ffs(ocr);
  383. if (bit) {
  384. bit -= 1;
  385. ocr &= 3 << bit;
  386. host->ios.vdd = bit;
  387. mmc_set_ios(host);
  388. } else {
  389. ocr = 0;
  390. }
  391. return ocr;
  392. }
  393. #define UNSTUFF_BITS(resp,start,size) \
  394. ({ \
  395. const int __size = size; \
  396. const u32 __mask = (__size < 32 ? 1 << __size : 0) - 1; \
  397. const int __off = 3 - ((start) / 32); \
  398. const int __shft = (start) & 31; \
  399. u32 __res; \
  400. \
  401. __res = resp[__off] >> __shft; \
  402. if (__size + __shft > 32) \
  403. __res |= resp[__off-1] << ((32 - __shft) % 32); \
  404. __res & __mask; \
  405. })
  406. /*
  407. * Given the decoded CSD structure, decode the raw CID to our CID structure.
  408. */
  409. static void mmc_decode_cid(struct mmc_card *card)
  410. {
  411. u32 *resp = card->raw_cid;
  412. memset(&card->cid, 0, sizeof(struct mmc_cid));
  413. if (mmc_card_sd(card)) {
  414. /*
  415. * SD doesn't currently have a version field so we will
  416. * have to assume we can parse this.
  417. */
  418. card->cid.manfid = UNSTUFF_BITS(resp, 120, 8);
  419. card->cid.oemid = UNSTUFF_BITS(resp, 104, 16);
  420. card->cid.prod_name[0] = UNSTUFF_BITS(resp, 96, 8);
  421. card->cid.prod_name[1] = UNSTUFF_BITS(resp, 88, 8);
  422. card->cid.prod_name[2] = UNSTUFF_BITS(resp, 80, 8);
  423. card->cid.prod_name[3] = UNSTUFF_BITS(resp, 72, 8);
  424. card->cid.prod_name[4] = UNSTUFF_BITS(resp, 64, 8);
  425. card->cid.hwrev = UNSTUFF_BITS(resp, 60, 4);
  426. card->cid.fwrev = UNSTUFF_BITS(resp, 56, 4);
  427. card->cid.serial = UNSTUFF_BITS(resp, 24, 32);
  428. card->cid.year = UNSTUFF_BITS(resp, 12, 8);
  429. card->cid.month = UNSTUFF_BITS(resp, 8, 4);
  430. card->cid.year += 2000; /* SD cards year offset */
  431. } else {
  432. /*
  433. * The selection of the format here is based upon published
  434. * specs from sandisk and from what people have reported.
  435. */
  436. switch (card->csd.mmca_vsn) {
  437. case 0: /* MMC v1.0 - v1.2 */
  438. case 1: /* MMC v1.4 */
  439. card->cid.manfid = UNSTUFF_BITS(resp, 104, 24);
  440. card->cid.prod_name[0] = UNSTUFF_BITS(resp, 96, 8);
  441. card->cid.prod_name[1] = UNSTUFF_BITS(resp, 88, 8);
  442. card->cid.prod_name[2] = UNSTUFF_BITS(resp, 80, 8);
  443. card->cid.prod_name[3] = UNSTUFF_BITS(resp, 72, 8);
  444. card->cid.prod_name[4] = UNSTUFF_BITS(resp, 64, 8);
  445. card->cid.prod_name[5] = UNSTUFF_BITS(resp, 56, 8);
  446. card->cid.prod_name[6] = UNSTUFF_BITS(resp, 48, 8);
  447. card->cid.hwrev = UNSTUFF_BITS(resp, 44, 4);
  448. card->cid.fwrev = UNSTUFF_BITS(resp, 40, 4);
  449. card->cid.serial = UNSTUFF_BITS(resp, 16, 24);
  450. card->cid.month = UNSTUFF_BITS(resp, 12, 4);
  451. card->cid.year = UNSTUFF_BITS(resp, 8, 4) + 1997;
  452. break;
  453. case 2: /* MMC v2.0 - v2.2 */
  454. case 3: /* MMC v3.1 - v3.3 */
  455. case 4: /* MMC v4 */
  456. card->cid.manfid = UNSTUFF_BITS(resp, 120, 8);
  457. card->cid.oemid = UNSTUFF_BITS(resp, 104, 16);
  458. card->cid.prod_name[0] = UNSTUFF_BITS(resp, 96, 8);
  459. card->cid.prod_name[1] = UNSTUFF_BITS(resp, 88, 8);
  460. card->cid.prod_name[2] = UNSTUFF_BITS(resp, 80, 8);
  461. card->cid.prod_name[3] = UNSTUFF_BITS(resp, 72, 8);
  462. card->cid.prod_name[4] = UNSTUFF_BITS(resp, 64, 8);
  463. card->cid.prod_name[5] = UNSTUFF_BITS(resp, 56, 8);
  464. card->cid.serial = UNSTUFF_BITS(resp, 16, 32);
  465. card->cid.month = UNSTUFF_BITS(resp, 12, 4);
  466. card->cid.year = UNSTUFF_BITS(resp, 8, 4) + 1997;
  467. break;
  468. default:
  469. printk("%s: card has unknown MMCA version %d\n",
  470. mmc_hostname(card->host), card->csd.mmca_vsn);
  471. mmc_card_set_bad(card);
  472. break;
  473. }
  474. }
  475. }
  476. /*
  477. * Given a 128-bit response, decode to our card CSD structure.
  478. */
  479. static void mmc_decode_csd(struct mmc_card *card)
  480. {
  481. struct mmc_csd *csd = &card->csd;
  482. unsigned int e, m, csd_struct;
  483. u32 *resp = card->raw_csd;
  484. if (mmc_card_sd(card)) {
  485. csd_struct = UNSTUFF_BITS(resp, 126, 2);
  486. if (csd_struct != 0) {
  487. printk("%s: unrecognised CSD structure version %d\n",
  488. mmc_hostname(card->host), csd_struct);
  489. mmc_card_set_bad(card);
  490. return;
  491. }
  492. m = UNSTUFF_BITS(resp, 115, 4);
  493. e = UNSTUFF_BITS(resp, 112, 3);
  494. csd->tacc_ns = (tacc_exp[e] * tacc_mant[m] + 9) / 10;
  495. csd->tacc_clks = UNSTUFF_BITS(resp, 104, 8) * 100;
  496. m = UNSTUFF_BITS(resp, 99, 4);
  497. e = UNSTUFF_BITS(resp, 96, 3);
  498. csd->max_dtr = tran_exp[e] * tran_mant[m];
  499. csd->cmdclass = UNSTUFF_BITS(resp, 84, 12);
  500. e = UNSTUFF_BITS(resp, 47, 3);
  501. m = UNSTUFF_BITS(resp, 62, 12);
  502. csd->capacity = (1 + m) << (e + 2);
  503. csd->read_blkbits = UNSTUFF_BITS(resp, 80, 4);
  504. csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
  505. csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
  506. csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
  507. csd->r2w_factor = UNSTUFF_BITS(resp, 26, 3);
  508. csd->write_blkbits = UNSTUFF_BITS(resp, 22, 4);
  509. csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
  510. } else {
  511. /*
  512. * We only understand CSD structure v1.1 and v1.2.
  513. * v1.2 has extra information in bits 15, 11 and 10.
  514. */
  515. csd_struct = UNSTUFF_BITS(resp, 126, 2);
  516. if (csd_struct != 1 && csd_struct != 2) {
  517. printk("%s: unrecognised CSD structure version %d\n",
  518. mmc_hostname(card->host), csd_struct);
  519. mmc_card_set_bad(card);
  520. return;
  521. }
  522. csd->mmca_vsn = UNSTUFF_BITS(resp, 122, 4);
  523. m = UNSTUFF_BITS(resp, 115, 4);
  524. e = UNSTUFF_BITS(resp, 112, 3);
  525. csd->tacc_ns = (tacc_exp[e] * tacc_mant[m] + 9) / 10;
  526. csd->tacc_clks = UNSTUFF_BITS(resp, 104, 8) * 100;
  527. m = UNSTUFF_BITS(resp, 99, 4);
  528. e = UNSTUFF_BITS(resp, 96, 3);
  529. csd->max_dtr = tran_exp[e] * tran_mant[m];
  530. csd->cmdclass = UNSTUFF_BITS(resp, 84, 12);
  531. e = UNSTUFF_BITS(resp, 47, 3);
  532. m = UNSTUFF_BITS(resp, 62, 12);
  533. csd->capacity = (1 + m) << (e + 2);
  534. csd->read_blkbits = UNSTUFF_BITS(resp, 80, 4);
  535. csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
  536. csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
  537. csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
  538. csd->r2w_factor = UNSTUFF_BITS(resp, 26, 3);
  539. csd->write_blkbits = UNSTUFF_BITS(resp, 22, 4);
  540. csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
  541. }
  542. }
  543. /*
  544. * Given a 64-bit response, decode to our card SCR structure.
  545. */
  546. static void mmc_decode_scr(struct mmc_card *card)
  547. {
  548. struct sd_scr *scr = &card->scr;
  549. unsigned int scr_struct;
  550. u32 resp[4];
  551. BUG_ON(!mmc_card_sd(card));
  552. resp[3] = card->raw_scr[1];
  553. resp[2] = card->raw_scr[0];
  554. scr_struct = UNSTUFF_BITS(resp, 60, 4);
  555. if (scr_struct != 0) {
  556. printk("%s: unrecognised SCR structure version %d\n",
  557. mmc_hostname(card->host), scr_struct);
  558. mmc_card_set_bad(card);
  559. return;
  560. }
  561. scr->sda_vsn = UNSTUFF_BITS(resp, 56, 4);
  562. scr->bus_widths = UNSTUFF_BITS(resp, 48, 4);
  563. }
  564. /*
  565. * Locate a MMC card on this MMC host given a raw CID.
  566. */
  567. static struct mmc_card *mmc_find_card(struct mmc_host *host, u32 *raw_cid)
  568. {
  569. struct mmc_card *card;
  570. list_for_each_entry(card, &host->cards, node) {
  571. if (memcmp(card->raw_cid, raw_cid, sizeof(card->raw_cid)) == 0)
  572. return card;
  573. }
  574. return NULL;
  575. }
  576. /*
  577. * Allocate a new MMC card, and assign a unique RCA.
  578. */
  579. static struct mmc_card *
  580. mmc_alloc_card(struct mmc_host *host, u32 *raw_cid, unsigned int *frca)
  581. {
  582. struct mmc_card *card, *c;
  583. unsigned int rca = *frca;
  584. card = kmalloc(sizeof(struct mmc_card), GFP_KERNEL);
  585. if (!card)
  586. return ERR_PTR(-ENOMEM);
  587. mmc_init_card(card, host);
  588. memcpy(card->raw_cid, raw_cid, sizeof(card->raw_cid));
  589. again:
  590. list_for_each_entry(c, &host->cards, node)
  591. if (c->rca == rca) {
  592. rca++;
  593. goto again;
  594. }
  595. card->rca = rca;
  596. *frca = rca;
  597. return card;
  598. }
  599. /*
  600. * Tell attached cards to go to IDLE state
  601. */
  602. static void mmc_idle_cards(struct mmc_host *host)
  603. {
  604. struct mmc_command cmd;
  605. host->ios.chip_select = MMC_CS_HIGH;
  606. mmc_set_ios(host);
  607. mmc_delay(1);
  608. cmd.opcode = MMC_GO_IDLE_STATE;
  609. cmd.arg = 0;
  610. cmd.flags = MMC_RSP_NONE | MMC_CMD_BC;
  611. mmc_wait_for_cmd(host, &cmd, 0);
  612. mmc_delay(1);
  613. host->ios.chip_select = MMC_CS_DONTCARE;
  614. mmc_set_ios(host);
  615. mmc_delay(1);
  616. }
  617. /*
  618. * Apply power to the MMC stack. This is a two-stage process.
  619. * First, we enable power to the card without the clock running.
  620. * We then wait a bit for the power to stabilise. Finally,
  621. * enable the bus drivers and clock to the card.
  622. *
  623. * We must _NOT_ enable the clock prior to power stablising.
  624. *
  625. * If a host does all the power sequencing itself, ignore the
  626. * initial MMC_POWER_UP stage.
  627. */
  628. static void mmc_power_up(struct mmc_host *host)
  629. {
  630. int bit = fls(host->ocr_avail) - 1;
  631. host->ios.vdd = bit;
  632. host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN;
  633. host->ios.chip_select = MMC_CS_DONTCARE;
  634. host->ios.power_mode = MMC_POWER_UP;
  635. host->ios.bus_width = MMC_BUS_WIDTH_1;
  636. mmc_set_ios(host);
  637. mmc_delay(1);
  638. host->ios.clock = host->f_min;
  639. host->ios.power_mode = MMC_POWER_ON;
  640. mmc_set_ios(host);
  641. mmc_delay(2);
  642. }
  643. static void mmc_power_off(struct mmc_host *host)
  644. {
  645. host->ios.clock = 0;
  646. host->ios.vdd = 0;
  647. host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN;
  648. host->ios.chip_select = MMC_CS_DONTCARE;
  649. host->ios.power_mode = MMC_POWER_OFF;
  650. host->ios.bus_width = MMC_BUS_WIDTH_1;
  651. mmc_set_ios(host);
  652. }
  653. static int mmc_send_op_cond(struct mmc_host *host, u32 ocr, u32 *rocr)
  654. {
  655. struct mmc_command cmd;
  656. int i, err = 0;
  657. cmd.opcode = MMC_SEND_OP_COND;
  658. cmd.arg = ocr;
  659. cmd.flags = MMC_RSP_R3 | MMC_CMD_BCR;
  660. for (i = 100; i; i--) {
  661. err = mmc_wait_for_cmd(host, &cmd, 0);
  662. if (err != MMC_ERR_NONE)
  663. break;
  664. if (cmd.resp[0] & MMC_CARD_BUSY || ocr == 0)
  665. break;
  666. err = MMC_ERR_TIMEOUT;
  667. mmc_delay(10);
  668. }
  669. if (rocr)
  670. *rocr = cmd.resp[0];
  671. return err;
  672. }
  673. static int mmc_send_app_op_cond(struct mmc_host *host, u32 ocr, u32 *rocr)
  674. {
  675. struct mmc_command cmd;
  676. int i, err = 0;
  677. cmd.opcode = SD_APP_OP_COND;
  678. cmd.arg = ocr;
  679. cmd.flags = MMC_RSP_R3 | MMC_CMD_BCR;
  680. for (i = 100; i; i--) {
  681. err = mmc_wait_for_app_cmd(host, 0, &cmd, CMD_RETRIES);
  682. if (err != MMC_ERR_NONE)
  683. break;
  684. if (cmd.resp[0] & MMC_CARD_BUSY || ocr == 0)
  685. break;
  686. err = MMC_ERR_TIMEOUT;
  687. mmc_delay(10);
  688. }
  689. if (rocr)
  690. *rocr = cmd.resp[0];
  691. return err;
  692. }
  693. /*
  694. * Discover cards by requesting their CID. If this command
  695. * times out, it is not an error; there are no further cards
  696. * to be discovered. Add new cards to the list.
  697. *
  698. * Create a mmc_card entry for each discovered card, assigning
  699. * it an RCA, and save the raw CID for decoding later.
  700. */
  701. static void mmc_discover_cards(struct mmc_host *host)
  702. {
  703. struct mmc_card *card;
  704. unsigned int first_rca = 1, err;
  705. while (1) {
  706. struct mmc_command cmd;
  707. cmd.opcode = MMC_ALL_SEND_CID;
  708. cmd.arg = 0;
  709. cmd.flags = MMC_RSP_R2 | MMC_CMD_BCR;
  710. err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
  711. if (err == MMC_ERR_TIMEOUT) {
  712. err = MMC_ERR_NONE;
  713. break;
  714. }
  715. if (err != MMC_ERR_NONE) {
  716. printk(KERN_ERR "%s: error requesting CID: %d\n",
  717. mmc_hostname(host), err);
  718. break;
  719. }
  720. card = mmc_find_card(host, cmd.resp);
  721. if (!card) {
  722. card = mmc_alloc_card(host, cmd.resp, &first_rca);
  723. if (IS_ERR(card)) {
  724. err = PTR_ERR(card);
  725. break;
  726. }
  727. list_add(&card->node, &host->cards);
  728. }
  729. card->state &= ~MMC_STATE_DEAD;
  730. if (host->mode == MMC_MODE_SD) {
  731. mmc_card_set_sd(card);
  732. cmd.opcode = SD_SEND_RELATIVE_ADDR;
  733. cmd.arg = 0;
  734. cmd.flags = MMC_RSP_R6 | MMC_CMD_BCR;
  735. err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
  736. if (err != MMC_ERR_NONE)
  737. mmc_card_set_dead(card);
  738. else {
  739. card->rca = cmd.resp[0] >> 16;
  740. if (!host->ops->get_ro) {
  741. printk(KERN_WARNING "%s: host does not "
  742. "support reading read-only "
  743. "switch. assuming write-enable.\n",
  744. mmc_hostname(host));
  745. } else {
  746. if (host->ops->get_ro(host))
  747. mmc_card_set_readonly(card);
  748. }
  749. }
  750. } else {
  751. cmd.opcode = MMC_SET_RELATIVE_ADDR;
  752. cmd.arg = card->rca << 16;
  753. cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
  754. err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
  755. if (err != MMC_ERR_NONE)
  756. mmc_card_set_dead(card);
  757. }
  758. }
  759. }
  760. static void mmc_read_csds(struct mmc_host *host)
  761. {
  762. struct mmc_card *card;
  763. list_for_each_entry(card, &host->cards, node) {
  764. struct mmc_command cmd;
  765. int err;
  766. if (card->state & (MMC_STATE_DEAD|MMC_STATE_PRESENT))
  767. continue;
  768. cmd.opcode = MMC_SEND_CSD;
  769. cmd.arg = card->rca << 16;
  770. cmd.flags = MMC_RSP_R2 | MMC_CMD_AC;
  771. err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
  772. if (err != MMC_ERR_NONE) {
  773. mmc_card_set_dead(card);
  774. continue;
  775. }
  776. memcpy(card->raw_csd, cmd.resp, sizeof(card->raw_csd));
  777. mmc_decode_csd(card);
  778. mmc_decode_cid(card);
  779. }
  780. }
  781. static void mmc_process_ext_csds(struct mmc_host *host)
  782. {
  783. int err;
  784. struct mmc_card *card;
  785. struct mmc_request mrq;
  786. struct mmc_command cmd;
  787. struct mmc_data data;
  788. struct scatterlist sg;
  789. /*
  790. * As the ext_csd is so large and mostly unused, we don't store the
  791. * raw block in mmc_card.
  792. */
  793. u8 *ext_csd;
  794. ext_csd = kmalloc(512, GFP_KERNEL);
  795. if (!ext_csd) {
  796. printk("%s: could not allocate a buffer to receive the ext_csd."
  797. "mmc v4 cards will be treated as v3.\n",
  798. mmc_hostname(host));
  799. return;
  800. }
  801. list_for_each_entry(card, &host->cards, node) {
  802. if (card->state & (MMC_STATE_DEAD|MMC_STATE_PRESENT))
  803. continue;
  804. if (mmc_card_sd(card))
  805. continue;
  806. if (card->csd.mmca_vsn < CSD_SPEC_VER_4)
  807. continue;
  808. err = mmc_select_card(host, card);
  809. if (err != MMC_ERR_NONE) {
  810. mmc_card_set_dead(card);
  811. continue;
  812. }
  813. memset(&cmd, 0, sizeof(struct mmc_command));
  814. cmd.opcode = MMC_SEND_EXT_CSD;
  815. cmd.arg = 0;
  816. cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
  817. memset(&data, 0, sizeof(struct mmc_data));
  818. mmc_set_data_timeout(&data, card, 0);
  819. data.blksz = 512;
  820. data.blocks = 1;
  821. data.flags = MMC_DATA_READ;
  822. data.sg = &sg;
  823. data.sg_len = 1;
  824. memset(&mrq, 0, sizeof(struct mmc_request));
  825. mrq.cmd = &cmd;
  826. mrq.data = &data;
  827. sg_init_one(&sg, ext_csd, 512);
  828. mmc_wait_for_req(host, &mrq);
  829. if (cmd.error != MMC_ERR_NONE || data.error != MMC_ERR_NONE) {
  830. mmc_card_set_dead(card);
  831. continue;
  832. }
  833. switch (ext_csd[EXT_CSD_CARD_TYPE]) {
  834. case EXT_CSD_CARD_TYPE_52 | EXT_CSD_CARD_TYPE_26:
  835. card->ext_csd.hs_max_dtr = 52000000;
  836. break;
  837. case EXT_CSD_CARD_TYPE_26:
  838. card->ext_csd.hs_max_dtr = 26000000;
  839. break;
  840. default:
  841. /* MMC v4 spec says this cannot happen */
  842. printk("%s: card is mmc v4 but doesn't support "
  843. "any high-speed modes.\n",
  844. mmc_hostname(card->host));
  845. mmc_card_set_bad(card);
  846. continue;
  847. }
  848. /* Activate highspeed support. */
  849. cmd.opcode = MMC_SWITCH;
  850. cmd.arg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
  851. (EXT_CSD_HS_TIMING << 16) |
  852. (1 << 8) |
  853. EXT_CSD_CMD_SET_NORMAL;
  854. cmd.flags = MMC_RSP_R1B | MMC_CMD_AC;
  855. err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
  856. if (err != MMC_ERR_NONE) {
  857. printk("%s: failed to switch card to mmc v4 "
  858. "high-speed mode.\n",
  859. mmc_hostname(card->host));
  860. continue;
  861. }
  862. mmc_card_set_highspeed(card);
  863. /* Check for host support for wide-bus modes. */
  864. if (!(host->caps & MMC_CAP_4_BIT_DATA)) {
  865. continue;
  866. }
  867. /* Activate 4-bit support. */
  868. cmd.opcode = MMC_SWITCH;
  869. cmd.arg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
  870. (EXT_CSD_BUS_WIDTH << 16) |
  871. (EXT_CSD_BUS_WIDTH_4 << 8) |
  872. EXT_CSD_CMD_SET_NORMAL;
  873. cmd.flags = MMC_RSP_R1B | MMC_CMD_AC;
  874. err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
  875. if (err != MMC_ERR_NONE) {
  876. printk("%s: failed to switch card to "
  877. "mmc v4 4-bit bus mode.\n",
  878. mmc_hostname(card->host));
  879. continue;
  880. }
  881. host->ios.bus_width = MMC_BUS_WIDTH_4;
  882. }
  883. kfree(ext_csd);
  884. mmc_deselect_cards(host);
  885. }
  886. static void mmc_read_scrs(struct mmc_host *host)
  887. {
  888. int err;
  889. struct mmc_card *card;
  890. struct mmc_request mrq;
  891. struct mmc_command cmd;
  892. struct mmc_data data;
  893. struct scatterlist sg;
  894. list_for_each_entry(card, &host->cards, node) {
  895. if (card->state & (MMC_STATE_DEAD|MMC_STATE_PRESENT))
  896. continue;
  897. if (!mmc_card_sd(card))
  898. continue;
  899. err = mmc_select_card(host, card);
  900. if (err != MMC_ERR_NONE) {
  901. mmc_card_set_dead(card);
  902. continue;
  903. }
  904. memset(&cmd, 0, sizeof(struct mmc_command));
  905. cmd.opcode = MMC_APP_CMD;
  906. cmd.arg = card->rca << 16;
  907. cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
  908. err = mmc_wait_for_cmd(host, &cmd, 0);
  909. if ((err != MMC_ERR_NONE) || !(cmd.resp[0] & R1_APP_CMD)) {
  910. mmc_card_set_dead(card);
  911. continue;
  912. }
  913. memset(&cmd, 0, sizeof(struct mmc_command));
  914. cmd.opcode = SD_APP_SEND_SCR;
  915. cmd.arg = 0;
  916. cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
  917. memset(&data, 0, sizeof(struct mmc_data));
  918. mmc_set_data_timeout(&data, card, 0);
  919. data.blksz = 1 << 3;
  920. data.blocks = 1;
  921. data.flags = MMC_DATA_READ;
  922. data.sg = &sg;
  923. data.sg_len = 1;
  924. memset(&mrq, 0, sizeof(struct mmc_request));
  925. mrq.cmd = &cmd;
  926. mrq.data = &data;
  927. sg_init_one(&sg, (u8*)card->raw_scr, 8);
  928. mmc_wait_for_req(host, &mrq);
  929. if (cmd.error != MMC_ERR_NONE || data.error != MMC_ERR_NONE) {
  930. mmc_card_set_dead(card);
  931. continue;
  932. }
  933. card->raw_scr[0] = ntohl(card->raw_scr[0]);
  934. card->raw_scr[1] = ntohl(card->raw_scr[1]);
  935. mmc_decode_scr(card);
  936. }
  937. mmc_deselect_cards(host);
  938. }
  939. static void mmc_read_switch_caps(struct mmc_host *host)
  940. {
  941. int err;
  942. struct mmc_card *card;
  943. struct mmc_request mrq;
  944. struct mmc_command cmd;
  945. struct mmc_data data;
  946. unsigned char *status;
  947. struct scatterlist sg;
  948. status = kmalloc(64, GFP_KERNEL);
  949. if (!status) {
  950. printk(KERN_WARNING "%s: Unable to allocate buffer for "
  951. "reading switch capabilities.\n",
  952. mmc_hostname(host));
  953. return;
  954. }
  955. list_for_each_entry(card, &host->cards, node) {
  956. if (card->state & (MMC_STATE_DEAD|MMC_STATE_PRESENT))
  957. continue;
  958. if (!mmc_card_sd(card))
  959. continue;
  960. if (card->scr.sda_vsn < SCR_SPEC_VER_1)
  961. continue;
  962. err = mmc_select_card(host, card);
  963. if (err != MMC_ERR_NONE) {
  964. mmc_card_set_dead(card);
  965. continue;
  966. }
  967. memset(&cmd, 0, sizeof(struct mmc_command));
  968. cmd.opcode = SD_SWITCH;
  969. cmd.arg = 0x00FFFFF1;
  970. cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
  971. memset(&data, 0, sizeof(struct mmc_data));
  972. mmc_set_data_timeout(&data, card, 0);
  973. data.blksz = 64;
  974. data.blocks = 1;
  975. data.flags = MMC_DATA_READ;
  976. data.sg = &sg;
  977. data.sg_len = 1;
  978. memset(&mrq, 0, sizeof(struct mmc_request));
  979. mrq.cmd = &cmd;
  980. mrq.data = &data;
  981. sg_init_one(&sg, status, 64);
  982. mmc_wait_for_req(host, &mrq);
  983. if (cmd.error != MMC_ERR_NONE || data.error != MMC_ERR_NONE) {
  984. mmc_card_set_dead(card);
  985. continue;
  986. }
  987. if (status[13] & 0x02)
  988. card->sw_caps.hs_max_dtr = 50000000;
  989. memset(&cmd, 0, sizeof(struct mmc_command));
  990. cmd.opcode = SD_SWITCH;
  991. cmd.arg = 0x80FFFFF1;
  992. cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
  993. memset(&data, 0, sizeof(struct mmc_data));
  994. mmc_set_data_timeout(&data, card, 0);
  995. data.blksz = 64;
  996. data.blocks = 1;
  997. data.flags = MMC_DATA_READ;
  998. data.sg = &sg;
  999. data.sg_len = 1;
  1000. memset(&mrq, 0, sizeof(struct mmc_request));
  1001. mrq.cmd = &cmd;
  1002. mrq.data = &data;
  1003. sg_init_one(&sg, status, 64);
  1004. mmc_wait_for_req(host, &mrq);
  1005. if (cmd.error != MMC_ERR_NONE || data.error != MMC_ERR_NONE) {
  1006. mmc_card_set_dead(card);
  1007. continue;
  1008. }
  1009. if ((status[16] & 0xF) != 1) {
  1010. printk(KERN_WARNING "%s: Problem switching card "
  1011. "into high-speed mode!\n",
  1012. mmc_hostname(host));
  1013. continue;
  1014. }
  1015. mmc_card_set_highspeed(card);
  1016. }
  1017. kfree(status);
  1018. mmc_deselect_cards(host);
  1019. }
  1020. static unsigned int mmc_calculate_clock(struct mmc_host *host)
  1021. {
  1022. struct mmc_card *card;
  1023. unsigned int max_dtr = host->f_max;
  1024. list_for_each_entry(card, &host->cards, node)
  1025. if (!mmc_card_dead(card)) {
  1026. if (mmc_card_highspeed(card) && mmc_card_sd(card)) {
  1027. if (max_dtr > card->sw_caps.hs_max_dtr)
  1028. max_dtr = card->sw_caps.hs_max_dtr;
  1029. } else if (mmc_card_highspeed(card) && !mmc_card_sd(card)) {
  1030. if (max_dtr > card->ext_csd.hs_max_dtr)
  1031. max_dtr = card->ext_csd.hs_max_dtr;
  1032. } else if (max_dtr > card->csd.max_dtr) {
  1033. max_dtr = card->csd.max_dtr;
  1034. }
  1035. }
  1036. pr_debug("%s: selected %d.%03dMHz transfer rate\n",
  1037. mmc_hostname(host),
  1038. max_dtr / 1000000, (max_dtr / 1000) % 1000);
  1039. return max_dtr;
  1040. }
  1041. /*
  1042. * Check whether cards we already know about are still present.
  1043. * We do this by requesting status, and checking whether a card
  1044. * responds.
  1045. *
  1046. * A request for status does not cause a state change in data
  1047. * transfer mode.
  1048. */
  1049. static void mmc_check_cards(struct mmc_host *host)
  1050. {
  1051. struct list_head *l, *n;
  1052. mmc_deselect_cards(host);
  1053. list_for_each_safe(l, n, &host->cards) {
  1054. struct mmc_card *card = mmc_list_to_card(l);
  1055. struct mmc_command cmd;
  1056. int err;
  1057. cmd.opcode = MMC_SEND_STATUS;
  1058. cmd.arg = card->rca << 16;
  1059. cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
  1060. err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
  1061. if (err == MMC_ERR_NONE)
  1062. continue;
  1063. mmc_card_set_dead(card);
  1064. }
  1065. }
  1066. static void mmc_setup(struct mmc_host *host)
  1067. {
  1068. if (host->ios.power_mode != MMC_POWER_ON) {
  1069. int err;
  1070. u32 ocr;
  1071. host->mode = MMC_MODE_SD;
  1072. mmc_power_up(host);
  1073. mmc_idle_cards(host);
  1074. err = mmc_send_app_op_cond(host, 0, &ocr);
  1075. /*
  1076. * If we fail to detect any SD cards then try
  1077. * searching for MMC cards.
  1078. */
  1079. if (err != MMC_ERR_NONE) {
  1080. host->mode = MMC_MODE_MMC;
  1081. err = mmc_send_op_cond(host, 0, &ocr);
  1082. if (err != MMC_ERR_NONE)
  1083. return;
  1084. }
  1085. host->ocr = mmc_select_voltage(host, ocr);
  1086. /*
  1087. * Since we're changing the OCR value, we seem to
  1088. * need to tell some cards to go back to the idle
  1089. * state. We wait 1ms to give cards time to
  1090. * respond.
  1091. */
  1092. if (host->ocr)
  1093. mmc_idle_cards(host);
  1094. } else {
  1095. host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN;
  1096. host->ios.clock = host->f_min;
  1097. mmc_set_ios(host);
  1098. /*
  1099. * We should remember the OCR mask from the existing
  1100. * cards, and detect the new cards OCR mask, combine
  1101. * the two and re-select the VDD. However, if we do
  1102. * change VDD, we should do an idle, and then do a
  1103. * full re-initialisation. We would need to notify
  1104. * drivers so that they can re-setup the cards as
  1105. * well, while keeping their queues at bay.
  1106. *
  1107. * For the moment, we take the easy way out - if the
  1108. * new cards don't like our currently selected VDD,
  1109. * they drop off the bus.
  1110. */
  1111. }
  1112. if (host->ocr == 0)
  1113. return;
  1114. /*
  1115. * Send the selected OCR multiple times... until the cards
  1116. * all get the idea that they should be ready for CMD2.
  1117. * (My SanDisk card seems to need this.)
  1118. */
  1119. if (host->mode == MMC_MODE_SD)
  1120. mmc_send_app_op_cond(host, host->ocr, NULL);
  1121. else
  1122. mmc_send_op_cond(host, host->ocr, NULL);
  1123. mmc_discover_cards(host);
  1124. /*
  1125. * Ok, now switch to push-pull mode.
  1126. */
  1127. host->ios.bus_mode = MMC_BUSMODE_PUSHPULL;
  1128. mmc_set_ios(host);
  1129. mmc_read_csds(host);
  1130. if (host->mode == MMC_MODE_SD) {
  1131. mmc_read_scrs(host);
  1132. mmc_read_switch_caps(host);
  1133. } else
  1134. mmc_process_ext_csds(host);
  1135. }
  1136. /**
  1137. * mmc_detect_change - process change of state on a MMC socket
  1138. * @host: host which changed state.
  1139. * @delay: optional delay to wait before detection (jiffies)
  1140. *
  1141. * All we know is that card(s) have been inserted or removed
  1142. * from the socket(s). We don't know which socket or cards.
  1143. */
  1144. void mmc_detect_change(struct mmc_host *host, unsigned long delay)
  1145. {
  1146. mmc_schedule_delayed_work(&host->detect, delay);
  1147. }
  1148. EXPORT_SYMBOL(mmc_detect_change);
  1149. static void mmc_rescan(struct work_struct *work)
  1150. {
  1151. struct mmc_host *host =
  1152. container_of(work, struct mmc_host, detect.work);
  1153. struct list_head *l, *n;
  1154. unsigned char power_mode;
  1155. mmc_claim_host(host);
  1156. /*
  1157. * Check for removed cards and newly inserted ones. We check for
  1158. * removed cards first so we can intelligently re-select the VDD.
  1159. */
  1160. power_mode = host->ios.power_mode;
  1161. if (power_mode == MMC_POWER_ON)
  1162. mmc_check_cards(host);
  1163. mmc_setup(host);
  1164. /*
  1165. * Some broken cards process CMD1 even in stand-by state. There is
  1166. * no reply, but an ILLEGAL_COMMAND error is cached and returned
  1167. * after next command. We poll for card status here to clear any
  1168. * possibly pending error.
  1169. */
  1170. if (power_mode == MMC_POWER_ON)
  1171. mmc_check_cards(host);
  1172. if (!list_empty(&host->cards)) {
  1173. /*
  1174. * (Re-)calculate the fastest clock rate which the
  1175. * attached cards and the host support.
  1176. */
  1177. host->ios.clock = mmc_calculate_clock(host);
  1178. mmc_set_ios(host);
  1179. }
  1180. mmc_release_host(host);
  1181. list_for_each_safe(l, n, &host->cards) {
  1182. struct mmc_card *card = mmc_list_to_card(l);
  1183. /*
  1184. * If this is a new and good card, register it.
  1185. */
  1186. if (!mmc_card_present(card) && !mmc_card_dead(card)) {
  1187. if (mmc_register_card(card))
  1188. mmc_card_set_dead(card);
  1189. else
  1190. mmc_card_set_present(card);
  1191. }
  1192. /*
  1193. * If this card is dead, destroy it.
  1194. */
  1195. if (mmc_card_dead(card)) {
  1196. list_del(&card->node);
  1197. mmc_remove_card(card);
  1198. }
  1199. }
  1200. /*
  1201. * If we discover that there are no cards on the
  1202. * bus, turn off the clock and power down.
  1203. */
  1204. if (list_empty(&host->cards))
  1205. mmc_power_off(host);
  1206. }
  1207. /**
  1208. * mmc_alloc_host - initialise the per-host structure.
  1209. * @extra: sizeof private data structure
  1210. * @dev: pointer to host device model structure
  1211. *
  1212. * Initialise the per-host structure.
  1213. */
  1214. struct mmc_host *mmc_alloc_host(int extra, struct device *dev)
  1215. {
  1216. struct mmc_host *host;
  1217. host = mmc_alloc_host_sysfs(extra, dev);
  1218. if (host) {
  1219. spin_lock_init(&host->lock);
  1220. init_waitqueue_head(&host->wq);
  1221. INIT_LIST_HEAD(&host->cards);
  1222. INIT_DELAYED_WORK(&host->detect, mmc_rescan);
  1223. /*
  1224. * By default, hosts do not support SGIO or large requests.
  1225. * They have to set these according to their abilities.
  1226. */
  1227. host->max_hw_segs = 1;
  1228. host->max_phys_segs = 1;
  1229. host->max_sectors = 1 << (PAGE_CACHE_SHIFT - 9);
  1230. host->max_seg_size = PAGE_CACHE_SIZE;
  1231. }
  1232. return host;
  1233. }
  1234. EXPORT_SYMBOL(mmc_alloc_host);
  1235. /**
  1236. * mmc_add_host - initialise host hardware
  1237. * @host: mmc host
  1238. */
  1239. int mmc_add_host(struct mmc_host *host)
  1240. {
  1241. int ret;
  1242. ret = mmc_add_host_sysfs(host);
  1243. if (ret == 0) {
  1244. mmc_power_off(host);
  1245. mmc_detect_change(host, 0);
  1246. }
  1247. return ret;
  1248. }
  1249. EXPORT_SYMBOL(mmc_add_host);
  1250. /**
  1251. * mmc_remove_host - remove host hardware
  1252. * @host: mmc host
  1253. *
  1254. * Unregister and remove all cards associated with this host,
  1255. * and power down the MMC bus.
  1256. */
  1257. void mmc_remove_host(struct mmc_host *host)
  1258. {
  1259. struct list_head *l, *n;
  1260. list_for_each_safe(l, n, &host->cards) {
  1261. struct mmc_card *card = mmc_list_to_card(l);
  1262. mmc_remove_card(card);
  1263. }
  1264. mmc_power_off(host);
  1265. mmc_remove_host_sysfs(host);
  1266. }
  1267. EXPORT_SYMBOL(mmc_remove_host);
  1268. /**
  1269. * mmc_free_host - free the host structure
  1270. * @host: mmc host
  1271. *
  1272. * Free the host once all references to it have been dropped.
  1273. */
  1274. void mmc_free_host(struct mmc_host *host)
  1275. {
  1276. mmc_flush_scheduled_work();
  1277. mmc_free_host_sysfs(host);
  1278. }
  1279. EXPORT_SYMBOL(mmc_free_host);
  1280. #ifdef CONFIG_PM
  1281. /**
  1282. * mmc_suspend_host - suspend a host
  1283. * @host: mmc host
  1284. * @state: suspend mode (PM_SUSPEND_xxx)
  1285. */
  1286. int mmc_suspend_host(struct mmc_host *host, pm_message_t state)
  1287. {
  1288. mmc_claim_host(host);
  1289. mmc_deselect_cards(host);
  1290. mmc_power_off(host);
  1291. mmc_release_host(host);
  1292. return 0;
  1293. }
  1294. EXPORT_SYMBOL(mmc_suspend_host);
  1295. /**
  1296. * mmc_resume_host - resume a previously suspended host
  1297. * @host: mmc host
  1298. */
  1299. int mmc_resume_host(struct mmc_host *host)
  1300. {
  1301. mmc_rescan(&host->detect.work);
  1302. return 0;
  1303. }
  1304. EXPORT_SYMBOL(mmc_resume_host);
  1305. #endif
  1306. MODULE_LICENSE("GPL");