sd.c 29 KB

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