sd.c 27 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168
  1. /*
  2. * linux/drivers/mmc/core/sd.c
  3. *
  4. * Copyright (C) 2003-2004 Russell King, All Rights Reserved.
  5. * SD support Copyright (C) 2004 Ian Molton, All Rights Reserved.
  6. * Copyright (C) 2005-2007 Pierre Ossman, All Rights Reserved.
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License version 2 as
  10. * published by the Free Software Foundation.
  11. */
  12. #include <linux/err.h>
  13. #include <linux/slab.h>
  14. #include <linux/mmc/host.h>
  15. #include <linux/mmc/card.h>
  16. #include <linux/mmc/mmc.h>
  17. #include <linux/mmc/sd.h>
  18. #include "core.h"
  19. #include "bus.h"
  20. #include "mmc_ops.h"
  21. #include "sd.h"
  22. #include "sd_ops.h"
  23. static const unsigned int tran_exp[] = {
  24. 10000, 100000, 1000000, 10000000,
  25. 0, 0, 0, 0
  26. };
  27. static const unsigned char tran_mant[] = {
  28. 0, 10, 12, 13, 15, 20, 25, 30,
  29. 35, 40, 45, 50, 55, 60, 70, 80,
  30. };
  31. static const unsigned int tacc_exp[] = {
  32. 1, 10, 100, 1000, 10000, 100000, 1000000, 10000000,
  33. };
  34. static const unsigned int tacc_mant[] = {
  35. 0, 10, 12, 13, 15, 20, 25, 30,
  36. 35, 40, 45, 50, 55, 60, 70, 80,
  37. };
  38. #define UNSTUFF_BITS(resp,start,size) \
  39. ({ \
  40. const int __size = size; \
  41. const u32 __mask = (__size < 32 ? 1 << __size : 0) - 1; \
  42. const int __off = 3 - ((start) / 32); \
  43. const int __shft = (start) & 31; \
  44. u32 __res; \
  45. \
  46. __res = resp[__off] >> __shft; \
  47. if (__size + __shft > 32) \
  48. __res |= resp[__off-1] << ((32 - __shft) % 32); \
  49. __res & __mask; \
  50. })
  51. /*
  52. * Given the decoded CSD structure, decode the raw CID to our CID structure.
  53. */
  54. void mmc_decode_cid(struct mmc_card *card)
  55. {
  56. u32 *resp = card->raw_cid;
  57. memset(&card->cid, 0, sizeof(struct mmc_cid));
  58. /*
  59. * SD doesn't currently have a version field so we will
  60. * have to assume we can parse this.
  61. */
  62. card->cid.manfid = UNSTUFF_BITS(resp, 120, 8);
  63. card->cid.oemid = UNSTUFF_BITS(resp, 104, 16);
  64. card->cid.prod_name[0] = UNSTUFF_BITS(resp, 96, 8);
  65. card->cid.prod_name[1] = UNSTUFF_BITS(resp, 88, 8);
  66. card->cid.prod_name[2] = UNSTUFF_BITS(resp, 80, 8);
  67. card->cid.prod_name[3] = UNSTUFF_BITS(resp, 72, 8);
  68. card->cid.prod_name[4] = UNSTUFF_BITS(resp, 64, 8);
  69. card->cid.hwrev = UNSTUFF_BITS(resp, 60, 4);
  70. card->cid.fwrev = UNSTUFF_BITS(resp, 56, 4);
  71. card->cid.serial = UNSTUFF_BITS(resp, 24, 32);
  72. card->cid.year = UNSTUFF_BITS(resp, 12, 8);
  73. card->cid.month = UNSTUFF_BITS(resp, 8, 4);
  74. card->cid.year += 2000; /* SD cards year offset */
  75. }
  76. /*
  77. * Given a 128-bit response, decode to our card CSD structure.
  78. */
  79. static int mmc_decode_csd(struct mmc_card *card)
  80. {
  81. struct mmc_csd *csd = &card->csd;
  82. unsigned int e, m, csd_struct;
  83. u32 *resp = card->raw_csd;
  84. csd_struct = UNSTUFF_BITS(resp, 126, 2);
  85. switch (csd_struct) {
  86. case 0:
  87. m = UNSTUFF_BITS(resp, 115, 4);
  88. e = UNSTUFF_BITS(resp, 112, 3);
  89. csd->tacc_ns = (tacc_exp[e] * tacc_mant[m] + 9) / 10;
  90. csd->tacc_clks = UNSTUFF_BITS(resp, 104, 8) * 100;
  91. m = UNSTUFF_BITS(resp, 99, 4);
  92. e = UNSTUFF_BITS(resp, 96, 3);
  93. csd->max_dtr = tran_exp[e] * tran_mant[m];
  94. csd->cmdclass = UNSTUFF_BITS(resp, 84, 12);
  95. e = UNSTUFF_BITS(resp, 47, 3);
  96. m = UNSTUFF_BITS(resp, 62, 12);
  97. csd->capacity = (1 + m) << (e + 2);
  98. csd->read_blkbits = UNSTUFF_BITS(resp, 80, 4);
  99. csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
  100. csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
  101. csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
  102. csd->r2w_factor = UNSTUFF_BITS(resp, 26, 3);
  103. csd->write_blkbits = UNSTUFF_BITS(resp, 22, 4);
  104. csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
  105. if (UNSTUFF_BITS(resp, 46, 1)) {
  106. csd->erase_size = 1;
  107. } else if (csd->write_blkbits >= 9) {
  108. csd->erase_size = UNSTUFF_BITS(resp, 39, 7) + 1;
  109. csd->erase_size <<= csd->write_blkbits - 9;
  110. }
  111. break;
  112. case 1:
  113. /*
  114. * This is a block-addressed SDHC or SDXC card. Most
  115. * interesting fields are unused and have fixed
  116. * values. To avoid getting tripped by buggy cards,
  117. * we assume those fixed values ourselves.
  118. */
  119. mmc_card_set_blockaddr(card);
  120. csd->tacc_ns = 0; /* Unused */
  121. csd->tacc_clks = 0; /* Unused */
  122. m = UNSTUFF_BITS(resp, 99, 4);
  123. e = UNSTUFF_BITS(resp, 96, 3);
  124. csd->max_dtr = tran_exp[e] * tran_mant[m];
  125. csd->cmdclass = UNSTUFF_BITS(resp, 84, 12);
  126. csd->c_size = UNSTUFF_BITS(resp, 48, 22);
  127. /* SDXC cards have a minimum C_SIZE of 0x00FFFF */
  128. if (csd->c_size >= 0xFFFF)
  129. mmc_card_set_ext_capacity(card);
  130. m = UNSTUFF_BITS(resp, 48, 22);
  131. csd->capacity = (1 + m) << 10;
  132. csd->read_blkbits = 9;
  133. csd->read_partial = 0;
  134. csd->write_misalign = 0;
  135. csd->read_misalign = 0;
  136. csd->r2w_factor = 4; /* Unused */
  137. csd->write_blkbits = 9;
  138. csd->write_partial = 0;
  139. csd->erase_size = 1;
  140. break;
  141. default:
  142. printk(KERN_ERR "%s: unrecognised CSD structure version %d\n",
  143. mmc_hostname(card->host), csd_struct);
  144. return -EINVAL;
  145. }
  146. card->erase_size = csd->erase_size;
  147. return 0;
  148. }
  149. /*
  150. * Given a 64-bit response, decode to our card SCR structure.
  151. */
  152. static int mmc_decode_scr(struct mmc_card *card)
  153. {
  154. struct sd_scr *scr = &card->scr;
  155. unsigned int scr_struct;
  156. u32 resp[4];
  157. resp[3] = card->raw_scr[1];
  158. resp[2] = card->raw_scr[0];
  159. scr_struct = UNSTUFF_BITS(resp, 60, 4);
  160. if (scr_struct != 0) {
  161. printk(KERN_ERR "%s: unrecognised SCR structure version %d\n",
  162. mmc_hostname(card->host), scr_struct);
  163. return -EINVAL;
  164. }
  165. scr->sda_vsn = UNSTUFF_BITS(resp, 56, 4);
  166. scr->bus_widths = UNSTUFF_BITS(resp, 48, 4);
  167. if (scr->sda_vsn == SCR_SPEC_VER_2)
  168. /* Check if Physical Layer Spec v3.0 is supported */
  169. scr->sda_spec3 = UNSTUFF_BITS(resp, 47, 1);
  170. if (UNSTUFF_BITS(resp, 55, 1))
  171. card->erased_byte = 0xFF;
  172. else
  173. card->erased_byte = 0x0;
  174. return 0;
  175. }
  176. /*
  177. * Fetch and process SD Status register.
  178. */
  179. static int mmc_read_ssr(struct mmc_card *card)
  180. {
  181. unsigned int au, es, et, eo;
  182. int err, i;
  183. u32 *ssr;
  184. if (!(card->csd.cmdclass & CCC_APP_SPEC)) {
  185. printk(KERN_WARNING "%s: card lacks mandatory SD Status "
  186. "function.\n", mmc_hostname(card->host));
  187. return 0;
  188. }
  189. ssr = kmalloc(64, GFP_KERNEL);
  190. if (!ssr)
  191. return -ENOMEM;
  192. err = mmc_app_sd_status(card, ssr);
  193. if (err) {
  194. printk(KERN_WARNING "%s: problem reading SD Status "
  195. "register.\n", mmc_hostname(card->host));
  196. err = 0;
  197. goto out;
  198. }
  199. for (i = 0; i < 16; i++)
  200. ssr[i] = be32_to_cpu(ssr[i]);
  201. /*
  202. * UNSTUFF_BITS only works with four u32s so we have to offset the
  203. * bitfield positions accordingly.
  204. */
  205. au = UNSTUFF_BITS(ssr, 428 - 384, 4);
  206. if (au > 0 || au <= 9) {
  207. card->ssr.au = 1 << (au + 4);
  208. es = UNSTUFF_BITS(ssr, 408 - 384, 16);
  209. et = UNSTUFF_BITS(ssr, 402 - 384, 6);
  210. eo = UNSTUFF_BITS(ssr, 400 - 384, 2);
  211. if (es && et) {
  212. card->ssr.erase_timeout = (et * 1000) / es;
  213. card->ssr.erase_offset = eo * 1000;
  214. }
  215. } else {
  216. printk(KERN_WARNING "%s: SD Status: Invalid Allocation Unit "
  217. "size.\n", mmc_hostname(card->host));
  218. }
  219. out:
  220. kfree(ssr);
  221. return err;
  222. }
  223. /*
  224. * Fetches and decodes switch information
  225. */
  226. static int mmc_read_switch(struct mmc_card *card)
  227. {
  228. int err;
  229. u8 *status;
  230. if (card->scr.sda_vsn < SCR_SPEC_VER_1)
  231. return 0;
  232. if (!(card->csd.cmdclass & CCC_SWITCH)) {
  233. printk(KERN_WARNING "%s: card lacks mandatory switch "
  234. "function, performance might suffer.\n",
  235. mmc_hostname(card->host));
  236. return 0;
  237. }
  238. err = -EIO;
  239. status = kmalloc(64, GFP_KERNEL);
  240. if (!status) {
  241. printk(KERN_ERR "%s: could not allocate a buffer for "
  242. "switch capabilities.\n",
  243. mmc_hostname(card->host));
  244. return -ENOMEM;
  245. }
  246. /* Find out the supported Bus Speed Modes. */
  247. err = mmc_sd_switch(card, 0, 0, 1, status);
  248. if (err) {
  249. /*
  250. * If the host or the card can't do the switch,
  251. * fail more gracefully.
  252. */
  253. if (err != -EINVAL && err != -ENOSYS && err != -EFAULT)
  254. goto out;
  255. printk(KERN_WARNING "%s: problem reading Bus Speed modes.\n",
  256. mmc_hostname(card->host));
  257. err = 0;
  258. goto out;
  259. }
  260. if (card->scr.sda_spec3) {
  261. card->sw_caps.sd3_bus_mode = status[13];
  262. /* Find out Driver Strengths supported by the card */
  263. err = mmc_sd_switch(card, 0, 2, 1, status);
  264. if (err) {
  265. /*
  266. * If the host or the card can't do the switch,
  267. * fail more gracefully.
  268. */
  269. if (err != -EINVAL && err != -ENOSYS && err != -EFAULT)
  270. goto out;
  271. printk(KERN_WARNING "%s: problem reading "
  272. "Driver Strength.\n",
  273. mmc_hostname(card->host));
  274. err = 0;
  275. goto out;
  276. }
  277. card->sw_caps.sd3_drv_type = status[9];
  278. /* Find out Current Limits supported by the card */
  279. err = mmc_sd_switch(card, 0, 3, 1, status);
  280. if (err) {
  281. /*
  282. * If the host or the card can't do the switch,
  283. * fail more gracefully.
  284. */
  285. if (err != -EINVAL && err != -ENOSYS && err != -EFAULT)
  286. goto out;
  287. printk(KERN_WARNING "%s: problem reading "
  288. "Current Limit.\n",
  289. mmc_hostname(card->host));
  290. err = 0;
  291. goto out;
  292. }
  293. card->sw_caps.sd3_curr_limit = status[7];
  294. } else {
  295. if (status[13] & 0x02)
  296. card->sw_caps.hs_max_dtr = 50000000;
  297. }
  298. out:
  299. kfree(status);
  300. return err;
  301. }
  302. /*
  303. * Test if the card supports high-speed mode and, if so, switch to it.
  304. */
  305. int mmc_sd_switch_hs(struct mmc_card *card)
  306. {
  307. int err;
  308. u8 *status;
  309. if (card->scr.sda_vsn < SCR_SPEC_VER_1)
  310. return 0;
  311. if (!(card->csd.cmdclass & CCC_SWITCH))
  312. return 0;
  313. if (!(card->host->caps & MMC_CAP_SD_HIGHSPEED))
  314. return 0;
  315. if (card->sw_caps.hs_max_dtr == 0)
  316. return 0;
  317. err = -EIO;
  318. status = kmalloc(64, GFP_KERNEL);
  319. if (!status) {
  320. printk(KERN_ERR "%s: could not allocate a buffer for "
  321. "switch capabilities.\n", mmc_hostname(card->host));
  322. return -ENOMEM;
  323. }
  324. err = mmc_sd_switch(card, 1, 0, 1, status);
  325. if (err)
  326. goto out;
  327. if ((status[16] & 0xF) != 1) {
  328. printk(KERN_WARNING "%s: Problem switching card "
  329. "into high-speed mode!\n",
  330. mmc_hostname(card->host));
  331. err = 0;
  332. } else {
  333. err = 1;
  334. }
  335. out:
  336. kfree(status);
  337. return err;
  338. }
  339. static int sd_select_driver_type(struct mmc_card *card, u8 *status)
  340. {
  341. int host_drv_type = 0, card_drv_type = 0;
  342. int err;
  343. /*
  344. * If the host doesn't support any of the Driver Types A,C or D,
  345. * default Driver Type B is used.
  346. */
  347. if (!(card->host->caps & (MMC_CAP_DRIVER_TYPE_A | MMC_CAP_DRIVER_TYPE_C
  348. | MMC_CAP_DRIVER_TYPE_D)))
  349. return 0;
  350. if (card->host->caps & MMC_CAP_DRIVER_TYPE_A) {
  351. host_drv_type = MMC_SET_DRIVER_TYPE_A;
  352. if (card->sw_caps.sd3_drv_type & SD_DRIVER_TYPE_A)
  353. card_drv_type = MMC_SET_DRIVER_TYPE_A;
  354. else if (card->sw_caps.sd3_drv_type & SD_DRIVER_TYPE_B)
  355. card_drv_type = MMC_SET_DRIVER_TYPE_B;
  356. else if (card->sw_caps.sd3_drv_type & SD_DRIVER_TYPE_C)
  357. card_drv_type = MMC_SET_DRIVER_TYPE_C;
  358. } else if (card->host->caps & MMC_CAP_DRIVER_TYPE_C) {
  359. host_drv_type = MMC_SET_DRIVER_TYPE_C;
  360. if (card->sw_caps.sd3_drv_type & SD_DRIVER_TYPE_C)
  361. card_drv_type = MMC_SET_DRIVER_TYPE_C;
  362. } else if (!(card->host->caps & MMC_CAP_DRIVER_TYPE_D)) {
  363. /*
  364. * If we are here, that means only the default driver type
  365. * B is supported by the host.
  366. */
  367. host_drv_type = MMC_SET_DRIVER_TYPE_B;
  368. if (card->sw_caps.sd3_drv_type & SD_DRIVER_TYPE_B)
  369. card_drv_type = MMC_SET_DRIVER_TYPE_B;
  370. else if (card->sw_caps.sd3_drv_type & SD_DRIVER_TYPE_C)
  371. card_drv_type = MMC_SET_DRIVER_TYPE_C;
  372. }
  373. err = mmc_sd_switch(card, 1, 2, card_drv_type, status);
  374. if (err)
  375. return err;
  376. if ((status[15] & 0xF) != card_drv_type) {
  377. printk(KERN_WARNING "%s: Problem setting driver strength!\n",
  378. mmc_hostname(card->host));
  379. return 0;
  380. }
  381. mmc_set_driver_type(card->host, host_drv_type);
  382. return 0;
  383. }
  384. static int sd_set_bus_speed_mode(struct mmc_card *card, u8 *status)
  385. {
  386. unsigned int bus_speed = 0, timing = 0;
  387. int err;
  388. /*
  389. * If the host doesn't support any of the UHS-I modes, fallback on
  390. * default speed.
  391. */
  392. if (!(card->host->caps & (MMC_CAP_UHS_SDR12 | MMC_CAP_UHS_SDR25 |
  393. MMC_CAP_UHS_SDR50 | MMC_CAP_UHS_SDR104 | MMC_CAP_UHS_DDR50)))
  394. return 0;
  395. if ((card->host->caps & MMC_CAP_UHS_SDR104) &&
  396. (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_SDR104)) {
  397. bus_speed = UHS_SDR104_BUS_SPEED;
  398. timing = MMC_TIMING_UHS_SDR104;
  399. card->sw_caps.uhs_max_dtr = UHS_SDR104_MAX_DTR;
  400. } else if ((card->host->caps & MMC_CAP_UHS_DDR50) &&
  401. (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_DDR50)) {
  402. bus_speed = UHS_DDR50_BUS_SPEED;
  403. timing = MMC_TIMING_UHS_DDR50;
  404. card->sw_caps.uhs_max_dtr = UHS_DDR50_MAX_DTR;
  405. } else if ((card->host->caps & (MMC_CAP_UHS_SDR104 |
  406. MMC_CAP_UHS_SDR50)) && (card->sw_caps.sd3_bus_mode &
  407. SD_MODE_UHS_SDR50)) {
  408. bus_speed = UHS_SDR50_BUS_SPEED;
  409. timing = MMC_TIMING_UHS_SDR50;
  410. card->sw_caps.uhs_max_dtr = UHS_SDR50_MAX_DTR;
  411. } else if ((card->host->caps & (MMC_CAP_UHS_SDR104 |
  412. MMC_CAP_UHS_SDR50 | MMC_CAP_UHS_SDR25)) &&
  413. (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_SDR25)) {
  414. bus_speed = UHS_SDR25_BUS_SPEED;
  415. timing = MMC_TIMING_UHS_SDR25;
  416. card->sw_caps.uhs_max_dtr = UHS_SDR25_MAX_DTR;
  417. } else if ((card->host->caps & (MMC_CAP_UHS_SDR104 |
  418. MMC_CAP_UHS_SDR50 | MMC_CAP_UHS_SDR25 |
  419. MMC_CAP_UHS_SDR12)) && (card->sw_caps.sd3_bus_mode &
  420. SD_MODE_UHS_SDR12)) {
  421. bus_speed = UHS_SDR12_BUS_SPEED;
  422. timing = MMC_TIMING_UHS_SDR12;
  423. card->sw_caps.uhs_max_dtr = UHS_SDR12_MAX_DTR;
  424. }
  425. card->sd_bus_speed = bus_speed;
  426. err = mmc_sd_switch(card, 1, 0, bus_speed, status);
  427. if (err)
  428. return err;
  429. if ((status[16] & 0xF) != bus_speed)
  430. printk(KERN_WARNING "%s: Problem setting bus speed mode!\n",
  431. mmc_hostname(card->host));
  432. else {
  433. mmc_set_timing(card->host, timing);
  434. mmc_set_clock(card->host, card->sw_caps.uhs_max_dtr);
  435. }
  436. return 0;
  437. }
  438. static int sd_set_current_limit(struct mmc_card *card, u8 *status)
  439. {
  440. int current_limit = 0;
  441. int err;
  442. /*
  443. * Current limit switch is only defined for SDR50, SDR104, and DDR50
  444. * bus speed modes. For other bus speed modes, we set the default
  445. * current limit of 200mA.
  446. */
  447. if ((card->sd_bus_speed == UHS_SDR50_BUS_SPEED) ||
  448. (card->sd_bus_speed == UHS_SDR104_BUS_SPEED) ||
  449. (card->sd_bus_speed == UHS_DDR50_BUS_SPEED)) {
  450. if (card->host->caps & MMC_CAP_MAX_CURRENT_800) {
  451. if (card->sw_caps.sd3_curr_limit & SD_MAX_CURRENT_800)
  452. current_limit = SD_SET_CURRENT_LIMIT_800;
  453. else if (card->sw_caps.sd3_curr_limit &
  454. SD_MAX_CURRENT_600)
  455. current_limit = SD_SET_CURRENT_LIMIT_600;
  456. else if (card->sw_caps.sd3_curr_limit &
  457. SD_MAX_CURRENT_400)
  458. current_limit = SD_SET_CURRENT_LIMIT_400;
  459. else if (card->sw_caps.sd3_curr_limit &
  460. SD_MAX_CURRENT_200)
  461. current_limit = SD_SET_CURRENT_LIMIT_200;
  462. } else if (card->host->caps & MMC_CAP_MAX_CURRENT_600) {
  463. if (card->sw_caps.sd3_curr_limit & SD_MAX_CURRENT_600)
  464. current_limit = SD_SET_CURRENT_LIMIT_600;
  465. else if (card->sw_caps.sd3_curr_limit &
  466. SD_MAX_CURRENT_400)
  467. current_limit = SD_SET_CURRENT_LIMIT_400;
  468. else if (card->sw_caps.sd3_curr_limit &
  469. SD_MAX_CURRENT_200)
  470. current_limit = SD_SET_CURRENT_LIMIT_200;
  471. } else if (card->host->caps & MMC_CAP_MAX_CURRENT_400) {
  472. if (card->sw_caps.sd3_curr_limit & SD_MAX_CURRENT_400)
  473. current_limit = SD_SET_CURRENT_LIMIT_400;
  474. else if (card->sw_caps.sd3_curr_limit &
  475. SD_MAX_CURRENT_200)
  476. current_limit = SD_SET_CURRENT_LIMIT_200;
  477. } else if (card->host->caps & MMC_CAP_MAX_CURRENT_200) {
  478. if (card->sw_caps.sd3_curr_limit & SD_MAX_CURRENT_200)
  479. current_limit = SD_SET_CURRENT_LIMIT_200;
  480. }
  481. } else
  482. current_limit = SD_SET_CURRENT_LIMIT_200;
  483. err = mmc_sd_switch(card, 1, 3, current_limit, status);
  484. if (err)
  485. return err;
  486. if (((status[15] >> 4) & 0x0F) != current_limit)
  487. printk(KERN_WARNING "%s: Problem setting current limit!\n",
  488. mmc_hostname(card->host));
  489. return 0;
  490. }
  491. /*
  492. * UHS-I specific initialization procedure
  493. */
  494. static int mmc_sd_init_uhs_card(struct mmc_card *card)
  495. {
  496. int err;
  497. u8 *status;
  498. if (!card->scr.sda_spec3)
  499. return 0;
  500. if (!(card->csd.cmdclass & CCC_SWITCH))
  501. return 0;
  502. status = kmalloc(64, GFP_KERNEL);
  503. if (!status) {
  504. printk(KERN_ERR "%s: could not allocate a buffer for "
  505. "switch capabilities.\n", mmc_hostname(card->host));
  506. return -ENOMEM;
  507. }
  508. /* Set 4-bit bus width */
  509. if ((card->host->caps & MMC_CAP_4_BIT_DATA) &&
  510. (card->scr.bus_widths & SD_SCR_BUS_WIDTH_4)) {
  511. err = mmc_app_set_bus_width(card, MMC_BUS_WIDTH_4);
  512. if (err)
  513. goto out;
  514. mmc_set_bus_width(card->host, MMC_BUS_WIDTH_4);
  515. }
  516. /* Set the driver strength for the card */
  517. err = sd_select_driver_type(card, status);
  518. if (err)
  519. goto out;
  520. /* Set bus speed mode of the card */
  521. err = sd_set_bus_speed_mode(card, status);
  522. if (err)
  523. goto out;
  524. /* Set current limit for the card */
  525. err = sd_set_current_limit(card, status);
  526. out:
  527. kfree(status);
  528. return err;
  529. }
  530. MMC_DEV_ATTR(cid, "%08x%08x%08x%08x\n", card->raw_cid[0], card->raw_cid[1],
  531. card->raw_cid[2], card->raw_cid[3]);
  532. MMC_DEV_ATTR(csd, "%08x%08x%08x%08x\n", card->raw_csd[0], card->raw_csd[1],
  533. card->raw_csd[2], card->raw_csd[3]);
  534. MMC_DEV_ATTR(scr, "%08x%08x\n", card->raw_scr[0], card->raw_scr[1]);
  535. MMC_DEV_ATTR(date, "%02d/%04d\n", card->cid.month, card->cid.year);
  536. MMC_DEV_ATTR(erase_size, "%u\n", card->erase_size << 9);
  537. MMC_DEV_ATTR(preferred_erase_size, "%u\n", card->pref_erase << 9);
  538. MMC_DEV_ATTR(fwrev, "0x%x\n", card->cid.fwrev);
  539. MMC_DEV_ATTR(hwrev, "0x%x\n", card->cid.hwrev);
  540. MMC_DEV_ATTR(manfid, "0x%06x\n", card->cid.manfid);
  541. MMC_DEV_ATTR(name, "%s\n", card->cid.prod_name);
  542. MMC_DEV_ATTR(oemid, "0x%04x\n", card->cid.oemid);
  543. MMC_DEV_ATTR(serial, "0x%08x\n", card->cid.serial);
  544. static struct attribute *sd_std_attrs[] = {
  545. &dev_attr_cid.attr,
  546. &dev_attr_csd.attr,
  547. &dev_attr_scr.attr,
  548. &dev_attr_date.attr,
  549. &dev_attr_erase_size.attr,
  550. &dev_attr_preferred_erase_size.attr,
  551. &dev_attr_fwrev.attr,
  552. &dev_attr_hwrev.attr,
  553. &dev_attr_manfid.attr,
  554. &dev_attr_name.attr,
  555. &dev_attr_oemid.attr,
  556. &dev_attr_serial.attr,
  557. NULL,
  558. };
  559. static struct attribute_group sd_std_attr_group = {
  560. .attrs = sd_std_attrs,
  561. };
  562. static const struct attribute_group *sd_attr_groups[] = {
  563. &sd_std_attr_group,
  564. NULL,
  565. };
  566. struct device_type sd_type = {
  567. .groups = sd_attr_groups,
  568. };
  569. /*
  570. * Fetch CID from card.
  571. */
  572. int mmc_sd_get_cid(struct mmc_host *host, u32 ocr, u32 *cid, u32 *rocr)
  573. {
  574. int err;
  575. /*
  576. * Since we're changing the OCR value, we seem to
  577. * need to tell some cards to go back to the idle
  578. * state. We wait 1ms to give cards time to
  579. * respond.
  580. */
  581. mmc_go_idle(host);
  582. /*
  583. * If SD_SEND_IF_COND indicates an SD 2.0
  584. * compliant card and we should set bit 30
  585. * of the ocr to indicate that we can handle
  586. * block-addressed SDHC cards.
  587. */
  588. err = mmc_send_if_cond(host, ocr);
  589. if (!err)
  590. ocr |= SD_OCR_CCS;
  591. /*
  592. * If the host supports one of UHS-I modes, request the card
  593. * to switch to 1.8V signaling level.
  594. */
  595. if (host->caps & (MMC_CAP_UHS_SDR12 | MMC_CAP_UHS_SDR25 |
  596. MMC_CAP_UHS_SDR50 | MMC_CAP_UHS_SDR104 | MMC_CAP_UHS_DDR50))
  597. ocr |= SD_OCR_S18R;
  598. /* If the host can supply more than 150mA, XPC should be set to 1. */
  599. if (host->caps & (MMC_CAP_SET_XPC_330 | MMC_CAP_SET_XPC_300 |
  600. MMC_CAP_SET_XPC_180))
  601. ocr |= SD_OCR_XPC;
  602. try_again:
  603. err = mmc_send_app_op_cond(host, ocr, rocr);
  604. if (err)
  605. return err;
  606. /*
  607. * In case CCS and S18A in the response is set, start Signal Voltage
  608. * Switch procedure. SPI mode doesn't support CMD11.
  609. */
  610. if (!mmc_host_is_spi(host) && rocr &&
  611. ((*rocr & 0x41000000) == 0x41000000)) {
  612. err = mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_180);
  613. if (err) {
  614. ocr &= ~SD_OCR_S18R;
  615. goto try_again;
  616. }
  617. }
  618. if (mmc_host_is_spi(host))
  619. err = mmc_send_cid(host, cid);
  620. else
  621. err = mmc_all_send_cid(host, cid);
  622. return err;
  623. }
  624. int mmc_sd_get_csd(struct mmc_host *host, struct mmc_card *card)
  625. {
  626. int err;
  627. /*
  628. * Fetch CSD from card.
  629. */
  630. err = mmc_send_csd(card, card->raw_csd);
  631. if (err)
  632. return err;
  633. err = mmc_decode_csd(card);
  634. if (err)
  635. return err;
  636. return 0;
  637. }
  638. int mmc_sd_setup_card(struct mmc_host *host, struct mmc_card *card,
  639. bool reinit)
  640. {
  641. int err;
  642. if (!reinit) {
  643. /*
  644. * Fetch SCR from card.
  645. */
  646. err = mmc_app_send_scr(card, card->raw_scr);
  647. if (err)
  648. return err;
  649. err = mmc_decode_scr(card);
  650. if (err)
  651. return err;
  652. /*
  653. * Fetch and process SD Status register.
  654. */
  655. err = mmc_read_ssr(card);
  656. if (err)
  657. return err;
  658. /* Erase init depends on CSD and SSR */
  659. mmc_init_erase(card);
  660. /*
  661. * Fetch switch information from card.
  662. */
  663. err = mmc_read_switch(card);
  664. if (err)
  665. return err;
  666. }
  667. /*
  668. * For SPI, enable CRC as appropriate.
  669. * This CRC enable is located AFTER the reading of the
  670. * card registers because some SDHC cards are not able
  671. * to provide valid CRCs for non-512-byte blocks.
  672. */
  673. if (mmc_host_is_spi(host)) {
  674. err = mmc_spi_set_crc(host, use_spi_crc);
  675. if (err)
  676. return err;
  677. }
  678. /*
  679. * Check if read-only switch is active.
  680. */
  681. if (!reinit) {
  682. int ro = -1;
  683. if (host->ops->get_ro)
  684. ro = host->ops->get_ro(host);
  685. if (ro < 0) {
  686. printk(KERN_WARNING "%s: host does not "
  687. "support reading read-only "
  688. "switch. assuming write-enable.\n",
  689. mmc_hostname(host));
  690. } else if (ro > 0) {
  691. mmc_card_set_readonly(card);
  692. }
  693. }
  694. return 0;
  695. }
  696. unsigned mmc_sd_get_max_clock(struct mmc_card *card)
  697. {
  698. unsigned max_dtr = (unsigned int)-1;
  699. if (mmc_card_highspeed(card)) {
  700. if (max_dtr > card->sw_caps.hs_max_dtr)
  701. max_dtr = card->sw_caps.hs_max_dtr;
  702. } else if (max_dtr > card->csd.max_dtr) {
  703. max_dtr = card->csd.max_dtr;
  704. }
  705. return max_dtr;
  706. }
  707. void mmc_sd_go_highspeed(struct mmc_card *card)
  708. {
  709. mmc_card_set_highspeed(card);
  710. mmc_set_timing(card->host, MMC_TIMING_SD_HS);
  711. }
  712. /*
  713. * Handle the detection and initialisation of a card.
  714. *
  715. * In the case of a resume, "oldcard" will contain the card
  716. * we're trying to reinitialise.
  717. */
  718. static int mmc_sd_init_card(struct mmc_host *host, u32 ocr,
  719. struct mmc_card *oldcard)
  720. {
  721. struct mmc_card *card;
  722. int err;
  723. u32 cid[4];
  724. u32 rocr = 0;
  725. BUG_ON(!host);
  726. WARN_ON(!host->claimed);
  727. err = mmc_sd_get_cid(host, ocr, cid, &rocr);
  728. if (err)
  729. return err;
  730. if (oldcard) {
  731. if (memcmp(cid, oldcard->raw_cid, sizeof(cid)) != 0)
  732. return -ENOENT;
  733. card = oldcard;
  734. } else {
  735. /*
  736. * Allocate card structure.
  737. */
  738. card = mmc_alloc_card(host, &sd_type);
  739. if (IS_ERR(card))
  740. return PTR_ERR(card);
  741. card->type = MMC_TYPE_SD;
  742. memcpy(card->raw_cid, cid, sizeof(card->raw_cid));
  743. }
  744. /*
  745. * For native busses: get card RCA and quit open drain mode.
  746. */
  747. if (!mmc_host_is_spi(host)) {
  748. err = mmc_send_relative_addr(host, &card->rca);
  749. if (err)
  750. return err;
  751. mmc_set_bus_mode(host, MMC_BUSMODE_PUSHPULL);
  752. }
  753. if (!oldcard) {
  754. err = mmc_sd_get_csd(host, card);
  755. if (err)
  756. return err;
  757. mmc_decode_cid(card);
  758. }
  759. /*
  760. * Select card, as all following commands rely on that.
  761. */
  762. if (!mmc_host_is_spi(host)) {
  763. err = mmc_select_card(card);
  764. if (err)
  765. return err;
  766. }
  767. err = mmc_sd_setup_card(host, card, oldcard != NULL);
  768. if (err)
  769. goto free_card;
  770. /* Initialization sequence for UHS-I cards */
  771. if (rocr & SD_ROCR_S18A) {
  772. err = mmc_sd_init_uhs_card(card);
  773. if (err)
  774. goto free_card;
  775. /* Card is an ultra-high-speed card */
  776. mmc_sd_card_set_uhs(card);
  777. } else {
  778. /*
  779. * Attempt to change to high-speed (if supported)
  780. */
  781. err = mmc_sd_switch_hs(card);
  782. if (err > 0)
  783. mmc_sd_go_highspeed(card);
  784. else if (err)
  785. goto free_card;
  786. /*
  787. * Set bus speed.
  788. */
  789. mmc_set_clock(host, mmc_sd_get_max_clock(card));
  790. /*
  791. * Switch to wider bus (if supported).
  792. */
  793. if ((host->caps & MMC_CAP_4_BIT_DATA) &&
  794. (card->scr.bus_widths & SD_SCR_BUS_WIDTH_4)) {
  795. err = mmc_app_set_bus_width(card, MMC_BUS_WIDTH_4);
  796. if (err)
  797. goto free_card;
  798. mmc_set_bus_width(host, MMC_BUS_WIDTH_4);
  799. }
  800. }
  801. host->card = card;
  802. return 0;
  803. free_card:
  804. if (!oldcard)
  805. mmc_remove_card(card);
  806. return err;
  807. }
  808. /*
  809. * Host is being removed. Free up the current card.
  810. */
  811. static void mmc_sd_remove(struct mmc_host *host)
  812. {
  813. BUG_ON(!host);
  814. BUG_ON(!host->card);
  815. mmc_remove_card(host->card);
  816. host->card = NULL;
  817. }
  818. /*
  819. * Card detection callback from host.
  820. */
  821. static void mmc_sd_detect(struct mmc_host *host)
  822. {
  823. int err;
  824. BUG_ON(!host);
  825. BUG_ON(!host->card);
  826. mmc_claim_host(host);
  827. /*
  828. * Just check if our card has been removed.
  829. */
  830. err = mmc_send_status(host->card, NULL);
  831. mmc_release_host(host);
  832. if (err) {
  833. mmc_sd_remove(host);
  834. mmc_claim_host(host);
  835. mmc_detach_bus(host);
  836. mmc_release_host(host);
  837. }
  838. }
  839. /*
  840. * Suspend callback from host.
  841. */
  842. static int mmc_sd_suspend(struct mmc_host *host)
  843. {
  844. BUG_ON(!host);
  845. BUG_ON(!host->card);
  846. mmc_claim_host(host);
  847. if (!mmc_host_is_spi(host))
  848. mmc_deselect_cards(host);
  849. host->card->state &= ~MMC_STATE_HIGHSPEED;
  850. mmc_release_host(host);
  851. return 0;
  852. }
  853. /*
  854. * Resume callback from host.
  855. *
  856. * This function tries to determine if the same card is still present
  857. * and, if so, restore all state to it.
  858. */
  859. static int mmc_sd_resume(struct mmc_host *host)
  860. {
  861. int err;
  862. BUG_ON(!host);
  863. BUG_ON(!host->card);
  864. mmc_claim_host(host);
  865. err = mmc_sd_init_card(host, host->ocr, host->card);
  866. mmc_release_host(host);
  867. return err;
  868. }
  869. static int mmc_sd_power_restore(struct mmc_host *host)
  870. {
  871. int ret;
  872. host->card->state &= ~MMC_STATE_HIGHSPEED;
  873. mmc_claim_host(host);
  874. ret = mmc_sd_init_card(host, host->ocr, host->card);
  875. mmc_release_host(host);
  876. return ret;
  877. }
  878. static const struct mmc_bus_ops mmc_sd_ops = {
  879. .remove = mmc_sd_remove,
  880. .detect = mmc_sd_detect,
  881. .suspend = NULL,
  882. .resume = NULL,
  883. .power_restore = mmc_sd_power_restore,
  884. };
  885. static const struct mmc_bus_ops mmc_sd_ops_unsafe = {
  886. .remove = mmc_sd_remove,
  887. .detect = mmc_sd_detect,
  888. .suspend = mmc_sd_suspend,
  889. .resume = mmc_sd_resume,
  890. .power_restore = mmc_sd_power_restore,
  891. };
  892. static void mmc_sd_attach_bus_ops(struct mmc_host *host)
  893. {
  894. const struct mmc_bus_ops *bus_ops;
  895. if (!mmc_card_is_removable(host))
  896. bus_ops = &mmc_sd_ops_unsafe;
  897. else
  898. bus_ops = &mmc_sd_ops;
  899. mmc_attach_bus(host, bus_ops);
  900. }
  901. /*
  902. * Starting point for SD card init.
  903. */
  904. int mmc_attach_sd(struct mmc_host *host)
  905. {
  906. int err;
  907. u32 ocr;
  908. BUG_ON(!host);
  909. WARN_ON(!host->claimed);
  910. /* Make sure we are at 3.3V signalling voltage */
  911. err = mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_330);
  912. if (err)
  913. return err;
  914. err = mmc_send_app_op_cond(host, 0, &ocr);
  915. if (err)
  916. return err;
  917. mmc_sd_attach_bus_ops(host);
  918. if (host->ocr_avail_sd)
  919. host->ocr_avail = host->ocr_avail_sd;
  920. /*
  921. * We need to get OCR a different way for SPI.
  922. */
  923. if (mmc_host_is_spi(host)) {
  924. mmc_go_idle(host);
  925. err = mmc_spi_read_ocr(host, 0, &ocr);
  926. if (err)
  927. goto err;
  928. }
  929. /*
  930. * Sanity check the voltages that the card claims to
  931. * support.
  932. */
  933. if (ocr & 0x7F) {
  934. printk(KERN_WARNING "%s: card claims to support voltages "
  935. "below the defined range. These will be ignored.\n",
  936. mmc_hostname(host));
  937. ocr &= ~0x7F;
  938. }
  939. if ((ocr & MMC_VDD_165_195) &&
  940. !(host->ocr_avail_sd & MMC_VDD_165_195)) {
  941. printk(KERN_WARNING "%s: SD card claims to support the "
  942. "incompletely defined 'low voltage range'. This "
  943. "will be ignored.\n", mmc_hostname(host));
  944. ocr &= ~MMC_VDD_165_195;
  945. }
  946. host->ocr = mmc_select_voltage(host, ocr);
  947. /*
  948. * Can we support the voltage(s) of the card(s)?
  949. */
  950. if (!host->ocr) {
  951. err = -EINVAL;
  952. goto err;
  953. }
  954. /*
  955. * Detect and init the card.
  956. */
  957. err = mmc_sd_init_card(host, host->ocr, NULL);
  958. if (err)
  959. goto err;
  960. mmc_release_host(host);
  961. err = mmc_add_card(host->card);
  962. mmc_claim_host(host);
  963. if (err)
  964. goto remove_card;
  965. return 0;
  966. remove_card:
  967. mmc_release_host(host);
  968. mmc_remove_card(host->card);
  969. host->card = NULL;
  970. mmc_claim_host(host);
  971. err:
  972. mmc_detach_bus(host);
  973. printk(KERN_ERR "%s: error %d whilst initialising SD card\n",
  974. mmc_hostname(host), err);
  975. return err;
  976. }