mmc.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938
  1. /*
  2. * Copyright 2008, Freescale Semiconductor, Inc
  3. * Andy Fleming
  4. *
  5. * Based vaguely on the Linux code
  6. *
  7. * See file CREDITS for list of people who contributed to this
  8. * project.
  9. *
  10. * This program is free software; you can redistribute it and/or
  11. * modify it under the terms of the GNU General Public License as
  12. * published by the Free Software Foundation; either version 2 of
  13. * the License, or (at your option) any later version.
  14. *
  15. * This program is distributed in the hope that it will be useful,
  16. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  18. * GNU General Public License for more details.
  19. *
  20. * You should have received a copy of the GNU General Public License
  21. * along with this program; if not, write to the Free Software
  22. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  23. * MA 02111-1307 USA
  24. */
  25. #include <config.h>
  26. #include <common.h>
  27. #include <command.h>
  28. #include <mmc.h>
  29. #include <part.h>
  30. #include <malloc.h>
  31. #include <linux/list.h>
  32. #include <mmc.h>
  33. #include <div64.h>
  34. static struct list_head mmc_devices;
  35. static int cur_dev_num = -1;
  36. int mmc_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd, struct mmc_data *data)
  37. {
  38. return mmc->send_cmd(mmc, cmd, data);
  39. }
  40. int mmc_set_blocklen(struct mmc *mmc, int len)
  41. {
  42. struct mmc_cmd cmd;
  43. cmd.cmdidx = MMC_CMD_SET_BLOCKLEN;
  44. cmd.resp_type = MMC_RSP_R1;
  45. cmd.cmdarg = len;
  46. cmd.flags = 0;
  47. return mmc_send_cmd(mmc, &cmd, NULL);
  48. }
  49. struct mmc *find_mmc_device(int dev_num)
  50. {
  51. struct mmc *m;
  52. struct list_head *entry;
  53. list_for_each(entry, &mmc_devices) {
  54. m = list_entry(entry, struct mmc, link);
  55. if (m->block_dev.dev == dev_num)
  56. return m;
  57. }
  58. printf("MMC Device %d not found\n", dev_num);
  59. return NULL;
  60. }
  61. static ulong
  62. mmc_bwrite(int dev_num, ulong start, lbaint_t blkcnt, const void*src)
  63. {
  64. struct mmc_cmd cmd;
  65. struct mmc_data data;
  66. int err;
  67. int stoperr = 0;
  68. struct mmc *mmc = find_mmc_device(dev_num);
  69. int blklen;
  70. if (!mmc)
  71. return -1;
  72. blklen = mmc->write_bl_len;
  73. err = mmc_set_blocklen(mmc, mmc->write_bl_len);
  74. if (err) {
  75. printf("set write bl len failed\n\r");
  76. return err;
  77. }
  78. if (blkcnt > 1)
  79. cmd.cmdidx = MMC_CMD_WRITE_MULTIPLE_BLOCK;
  80. else
  81. cmd.cmdidx = MMC_CMD_WRITE_SINGLE_BLOCK;
  82. if (mmc->high_capacity)
  83. cmd.cmdarg = start;
  84. else
  85. cmd.cmdarg = start * blklen;
  86. cmd.resp_type = MMC_RSP_R1;
  87. cmd.flags = 0;
  88. data.src = src;
  89. data.blocks = blkcnt;
  90. data.blocksize = blklen;
  91. data.flags = MMC_DATA_WRITE;
  92. err = mmc_send_cmd(mmc, &cmd, &data);
  93. if (err) {
  94. printf("mmc write failed\n\r");
  95. return err;
  96. }
  97. if (blkcnt > 1) {
  98. cmd.cmdidx = MMC_CMD_STOP_TRANSMISSION;
  99. cmd.cmdarg = 0;
  100. cmd.resp_type = MMC_RSP_R1b;
  101. cmd.flags = 0;
  102. stoperr = mmc_send_cmd(mmc, &cmd, NULL);
  103. }
  104. return blkcnt;
  105. }
  106. int mmc_read_block(struct mmc *mmc, void *dst, uint blocknum)
  107. {
  108. struct mmc_cmd cmd;
  109. struct mmc_data data;
  110. cmd.cmdidx = MMC_CMD_READ_SINGLE_BLOCK;
  111. if (mmc->high_capacity)
  112. cmd.cmdarg = blocknum;
  113. else
  114. cmd.cmdarg = blocknum * mmc->read_bl_len;
  115. cmd.resp_type = MMC_RSP_R1;
  116. cmd.flags = 0;
  117. data.dest = dst;
  118. data.blocks = 1;
  119. data.blocksize = mmc->read_bl_len;
  120. data.flags = MMC_DATA_READ;
  121. return mmc_send_cmd(mmc, &cmd, &data);
  122. }
  123. int mmc_read(struct mmc *mmc, u64 src, uchar *dst, int size)
  124. {
  125. char *buffer;
  126. int i;
  127. int blklen = mmc->read_bl_len;
  128. int startblock = lldiv(src, mmc->read_bl_len);
  129. int endblock = lldiv(src + size - 1, mmc->read_bl_len);
  130. int err = 0;
  131. /* Make a buffer big enough to hold all the blocks we might read */
  132. buffer = malloc(blklen);
  133. if (!buffer) {
  134. printf("Could not allocate buffer for MMC read!\n");
  135. return -1;
  136. }
  137. /* We always do full block reads from the card */
  138. err = mmc_set_blocklen(mmc, mmc->read_bl_len);
  139. if (err)
  140. return err;
  141. for (i = startblock; i <= endblock; i++) {
  142. int segment_size;
  143. int offset;
  144. err = mmc_read_block(mmc, buffer, i);
  145. if (err)
  146. goto free_buffer;
  147. /*
  148. * The first block may not be aligned, so we
  149. * copy from the desired point in the block
  150. */
  151. offset = (src & (blklen - 1));
  152. segment_size = MIN(blklen - offset, size);
  153. memcpy(dst, buffer + offset, segment_size);
  154. dst += segment_size;
  155. src += segment_size;
  156. size -= segment_size;
  157. }
  158. free_buffer:
  159. free(buffer);
  160. return err;
  161. }
  162. static ulong mmc_bread(int dev_num, ulong start, lbaint_t blkcnt, void *dst)
  163. {
  164. int err;
  165. int i;
  166. struct mmc *mmc = find_mmc_device(dev_num);
  167. if (!mmc)
  168. return 0;
  169. /* We always do full block reads from the card */
  170. err = mmc_set_blocklen(mmc, mmc->read_bl_len);
  171. if (err) {
  172. return 0;
  173. }
  174. for (i = start; i < start + blkcnt; i++, dst += mmc->read_bl_len) {
  175. err = mmc_read_block(mmc, dst, i);
  176. if (err) {
  177. printf("block read failed: %d\n", err);
  178. return i - start;
  179. }
  180. }
  181. return blkcnt;
  182. }
  183. int mmc_go_idle(struct mmc* mmc)
  184. {
  185. struct mmc_cmd cmd;
  186. int err;
  187. udelay(1000);
  188. cmd.cmdidx = MMC_CMD_GO_IDLE_STATE;
  189. cmd.cmdarg = 0;
  190. cmd.resp_type = MMC_RSP_NONE;
  191. cmd.flags = 0;
  192. err = mmc_send_cmd(mmc, &cmd, NULL);
  193. if (err)
  194. return err;
  195. udelay(2000);
  196. return 0;
  197. }
  198. int
  199. sd_send_op_cond(struct mmc *mmc)
  200. {
  201. int timeout = 1000;
  202. int err;
  203. struct mmc_cmd cmd;
  204. do {
  205. cmd.cmdidx = MMC_CMD_APP_CMD;
  206. cmd.resp_type = MMC_RSP_R1;
  207. cmd.cmdarg = 0;
  208. cmd.flags = 0;
  209. err = mmc_send_cmd(mmc, &cmd, NULL);
  210. if (err)
  211. return err;
  212. cmd.cmdidx = SD_CMD_APP_SEND_OP_COND;
  213. cmd.resp_type = MMC_RSP_R3;
  214. /*
  215. * Most cards do not answer if some reserved bits
  216. * in the ocr are set. However, Some controller
  217. * can set bit 7 (reserved for low voltages), but
  218. * how to manage low voltages SD card is not yet
  219. * specified.
  220. */
  221. cmd.cmdarg = mmc->voltages & 0xff8000;
  222. if (mmc->version == SD_VERSION_2)
  223. cmd.cmdarg |= OCR_HCS;
  224. err = mmc_send_cmd(mmc, &cmd, NULL);
  225. if (err)
  226. return err;
  227. udelay(1000);
  228. } while ((!(cmd.response[0] & OCR_BUSY)) && timeout--);
  229. if (timeout <= 0)
  230. return UNUSABLE_ERR;
  231. if (mmc->version != SD_VERSION_2)
  232. mmc->version = SD_VERSION_1_0;
  233. mmc->ocr = cmd.response[0];
  234. mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
  235. mmc->rca = 0;
  236. return 0;
  237. }
  238. int mmc_send_op_cond(struct mmc *mmc)
  239. {
  240. int timeout = 1000;
  241. struct mmc_cmd cmd;
  242. int err;
  243. /* Some cards seem to need this */
  244. mmc_go_idle(mmc);
  245. do {
  246. cmd.cmdidx = MMC_CMD_SEND_OP_COND;
  247. cmd.resp_type = MMC_RSP_R3;
  248. cmd.cmdarg = OCR_HCS | mmc->voltages;
  249. cmd.flags = 0;
  250. err = mmc_send_cmd(mmc, &cmd, NULL);
  251. if (err)
  252. return err;
  253. udelay(1000);
  254. } while (!(cmd.response[0] & OCR_BUSY) && timeout--);
  255. if (timeout <= 0)
  256. return UNUSABLE_ERR;
  257. mmc->version = MMC_VERSION_UNKNOWN;
  258. mmc->ocr = cmd.response[0];
  259. mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
  260. mmc->rca = 0;
  261. return 0;
  262. }
  263. int mmc_send_ext_csd(struct mmc *mmc, char *ext_csd)
  264. {
  265. struct mmc_cmd cmd;
  266. struct mmc_data data;
  267. int err;
  268. /* Get the Card Status Register */
  269. cmd.cmdidx = MMC_CMD_SEND_EXT_CSD;
  270. cmd.resp_type = MMC_RSP_R1;
  271. cmd.cmdarg = 0;
  272. cmd.flags = 0;
  273. data.dest = ext_csd;
  274. data.blocks = 1;
  275. data.blocksize = 512;
  276. data.flags = MMC_DATA_READ;
  277. err = mmc_send_cmd(mmc, &cmd, &data);
  278. return err;
  279. }
  280. int mmc_switch(struct mmc *mmc, u8 set, u8 index, u8 value)
  281. {
  282. struct mmc_cmd cmd;
  283. cmd.cmdidx = MMC_CMD_SWITCH;
  284. cmd.resp_type = MMC_RSP_R1b;
  285. cmd.cmdarg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
  286. (index << 16) |
  287. (value << 8);
  288. cmd.flags = 0;
  289. return mmc_send_cmd(mmc, &cmd, NULL);
  290. }
  291. int mmc_change_freq(struct mmc *mmc)
  292. {
  293. char ext_csd[512];
  294. char cardtype;
  295. int err;
  296. mmc->card_caps = 0;
  297. /* Only version 4 supports high-speed */
  298. if (mmc->version < MMC_VERSION_4)
  299. return 0;
  300. mmc->card_caps |= MMC_MODE_4BIT;
  301. err = mmc_send_ext_csd(mmc, ext_csd);
  302. if (err)
  303. return err;
  304. if (ext_csd[212] || ext_csd[213] || ext_csd[214] || ext_csd[215])
  305. mmc->high_capacity = 1;
  306. cardtype = ext_csd[196] & 0xf;
  307. err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_HS_TIMING, 1);
  308. if (err)
  309. return err;
  310. /* Now check to see that it worked */
  311. err = mmc_send_ext_csd(mmc, ext_csd);
  312. if (err)
  313. return err;
  314. /* No high-speed support */
  315. if (!ext_csd[185])
  316. return 0;
  317. /* High Speed is set, there are two types: 52MHz and 26MHz */
  318. if (cardtype & MMC_HS_52MHZ)
  319. mmc->card_caps |= MMC_MODE_HS_52MHz | MMC_MODE_HS;
  320. else
  321. mmc->card_caps |= MMC_MODE_HS;
  322. return 0;
  323. }
  324. int sd_switch(struct mmc *mmc, int mode, int group, u8 value, u8 *resp)
  325. {
  326. struct mmc_cmd cmd;
  327. struct mmc_data data;
  328. /* Switch the frequency */
  329. cmd.cmdidx = SD_CMD_SWITCH_FUNC;
  330. cmd.resp_type = MMC_RSP_R1;
  331. cmd.cmdarg = (mode << 31) | 0xffffff;
  332. cmd.cmdarg &= ~(0xf << (group * 4));
  333. cmd.cmdarg |= value << (group * 4);
  334. cmd.flags = 0;
  335. data.dest = (char *)resp;
  336. data.blocksize = 64;
  337. data.blocks = 1;
  338. data.flags = MMC_DATA_READ;
  339. return mmc_send_cmd(mmc, &cmd, &data);
  340. }
  341. int sd_change_freq(struct mmc *mmc)
  342. {
  343. int err;
  344. struct mmc_cmd cmd;
  345. uint scr[2];
  346. uint switch_status[16];
  347. struct mmc_data data;
  348. int timeout;
  349. mmc->card_caps = 0;
  350. /* Read the SCR to find out if this card supports higher speeds */
  351. cmd.cmdidx = MMC_CMD_APP_CMD;
  352. cmd.resp_type = MMC_RSP_R1;
  353. cmd.cmdarg = mmc->rca << 16;
  354. cmd.flags = 0;
  355. err = mmc_send_cmd(mmc, &cmd, NULL);
  356. if (err)
  357. return err;
  358. cmd.cmdidx = SD_CMD_APP_SEND_SCR;
  359. cmd.resp_type = MMC_RSP_R1;
  360. cmd.cmdarg = 0;
  361. cmd.flags = 0;
  362. timeout = 3;
  363. retry_scr:
  364. data.dest = (char *)&scr;
  365. data.blocksize = 8;
  366. data.blocks = 1;
  367. data.flags = MMC_DATA_READ;
  368. err = mmc_send_cmd(mmc, &cmd, &data);
  369. if (err) {
  370. if (timeout--)
  371. goto retry_scr;
  372. return err;
  373. }
  374. mmc->scr[0] = __be32_to_cpu(scr[0]);
  375. mmc->scr[1] = __be32_to_cpu(scr[1]);
  376. switch ((mmc->scr[0] >> 24) & 0xf) {
  377. case 0:
  378. mmc->version = SD_VERSION_1_0;
  379. break;
  380. case 1:
  381. mmc->version = SD_VERSION_1_10;
  382. break;
  383. case 2:
  384. mmc->version = SD_VERSION_2;
  385. break;
  386. default:
  387. mmc->version = SD_VERSION_1_0;
  388. break;
  389. }
  390. /* Version 1.0 doesn't support switching */
  391. if (mmc->version == SD_VERSION_1_0)
  392. return 0;
  393. timeout = 4;
  394. while (timeout--) {
  395. err = sd_switch(mmc, SD_SWITCH_CHECK, 0, 1,
  396. (u8 *)&switch_status);
  397. if (err)
  398. return err;
  399. /* The high-speed function is busy. Try again */
  400. if (!(__be32_to_cpu(switch_status[7]) & SD_HIGHSPEED_BUSY))
  401. break;
  402. }
  403. if (mmc->scr[0] & SD_DATA_4BIT)
  404. mmc->card_caps |= MMC_MODE_4BIT;
  405. /* If high-speed isn't supported, we return */
  406. if (!(__be32_to_cpu(switch_status[3]) & SD_HIGHSPEED_SUPPORTED))
  407. return 0;
  408. err = sd_switch(mmc, SD_SWITCH_SWITCH, 0, 1, (u8 *)&switch_status);
  409. if (err)
  410. return err;
  411. if ((__be32_to_cpu(switch_status[4]) & 0x0f000000) == 0x01000000)
  412. mmc->card_caps |= MMC_MODE_HS;
  413. return 0;
  414. }
  415. /* frequency bases */
  416. /* divided by 10 to be nice to platforms without floating point */
  417. int fbase[] = {
  418. 10000,
  419. 100000,
  420. 1000000,
  421. 10000000,
  422. };
  423. /* Multiplier values for TRAN_SPEED. Multiplied by 10 to be nice
  424. * to platforms without floating point.
  425. */
  426. int multipliers[] = {
  427. 0, /* reserved */
  428. 10,
  429. 12,
  430. 13,
  431. 15,
  432. 20,
  433. 25,
  434. 30,
  435. 35,
  436. 40,
  437. 45,
  438. 50,
  439. 55,
  440. 60,
  441. 70,
  442. 80,
  443. };
  444. void mmc_set_ios(struct mmc *mmc)
  445. {
  446. mmc->set_ios(mmc);
  447. }
  448. void mmc_set_clock(struct mmc *mmc, uint clock)
  449. {
  450. if (clock > mmc->f_max)
  451. clock = mmc->f_max;
  452. if (clock < mmc->f_min)
  453. clock = mmc->f_min;
  454. mmc->clock = clock;
  455. mmc_set_ios(mmc);
  456. }
  457. void mmc_set_bus_width(struct mmc *mmc, uint width)
  458. {
  459. mmc->bus_width = width;
  460. mmc_set_ios(mmc);
  461. }
  462. int mmc_startup(struct mmc *mmc)
  463. {
  464. int err;
  465. uint mult, freq;
  466. u64 cmult, csize;
  467. struct mmc_cmd cmd;
  468. /* Put the Card in Identify Mode */
  469. cmd.cmdidx = MMC_CMD_ALL_SEND_CID;
  470. cmd.resp_type = MMC_RSP_R2;
  471. cmd.cmdarg = 0;
  472. cmd.flags = 0;
  473. err = mmc_send_cmd(mmc, &cmd, NULL);
  474. if (err)
  475. return err;
  476. memcpy(mmc->cid, cmd.response, 16);
  477. /*
  478. * For MMC cards, set the Relative Address.
  479. * For SD cards, get the Relatvie Address.
  480. * This also puts the cards into Standby State
  481. */
  482. cmd.cmdidx = SD_CMD_SEND_RELATIVE_ADDR;
  483. cmd.cmdarg = mmc->rca << 16;
  484. cmd.resp_type = MMC_RSP_R6;
  485. cmd.flags = 0;
  486. err = mmc_send_cmd(mmc, &cmd, NULL);
  487. if (err)
  488. return err;
  489. if (IS_SD(mmc))
  490. mmc->rca = (cmd.response[0] >> 16) & 0xffff;
  491. /* Get the Card-Specific Data */
  492. cmd.cmdidx = MMC_CMD_SEND_CSD;
  493. cmd.resp_type = MMC_RSP_R2;
  494. cmd.cmdarg = mmc->rca << 16;
  495. cmd.flags = 0;
  496. err = mmc_send_cmd(mmc, &cmd, NULL);
  497. if (err)
  498. return err;
  499. mmc->csd[0] = cmd.response[0];
  500. mmc->csd[1] = cmd.response[1];
  501. mmc->csd[2] = cmd.response[2];
  502. mmc->csd[3] = cmd.response[3];
  503. if (mmc->version == MMC_VERSION_UNKNOWN) {
  504. int version = (cmd.response[0] >> 26) & 0xf;
  505. switch (version) {
  506. case 0:
  507. mmc->version = MMC_VERSION_1_2;
  508. break;
  509. case 1:
  510. mmc->version = MMC_VERSION_1_4;
  511. break;
  512. case 2:
  513. mmc->version = MMC_VERSION_2_2;
  514. break;
  515. case 3:
  516. mmc->version = MMC_VERSION_3;
  517. break;
  518. case 4:
  519. mmc->version = MMC_VERSION_4;
  520. break;
  521. default:
  522. mmc->version = MMC_VERSION_1_2;
  523. break;
  524. }
  525. }
  526. /* divide frequency by 10, since the mults are 10x bigger */
  527. freq = fbase[(cmd.response[0] & 0x7)];
  528. mult = multipliers[((cmd.response[0] >> 3) & 0xf)];
  529. mmc->tran_speed = freq * mult;
  530. mmc->read_bl_len = 1 << ((cmd.response[1] >> 16) & 0xf);
  531. if (IS_SD(mmc))
  532. mmc->write_bl_len = mmc->read_bl_len;
  533. else
  534. mmc->write_bl_len = 1 << ((cmd.response[3] >> 22) & 0xf);
  535. if (mmc->high_capacity) {
  536. csize = (mmc->csd[1] & 0x3f) << 16
  537. | (mmc->csd[2] & 0xffff0000) >> 16;
  538. cmult = 8;
  539. } else {
  540. csize = (mmc->csd[1] & 0x3ff) << 2
  541. | (mmc->csd[2] & 0xc0000000) >> 30;
  542. cmult = (mmc->csd[2] & 0x00038000) >> 15;
  543. }
  544. mmc->capacity = (csize + 1) << (cmult + 2);
  545. mmc->capacity *= mmc->read_bl_len;
  546. if (mmc->read_bl_len > 512)
  547. mmc->read_bl_len = 512;
  548. if (mmc->write_bl_len > 512)
  549. mmc->write_bl_len = 512;
  550. /* Select the card, and put it into Transfer Mode */
  551. cmd.cmdidx = MMC_CMD_SELECT_CARD;
  552. cmd.resp_type = MMC_RSP_R1b;
  553. cmd.cmdarg = mmc->rca << 16;
  554. cmd.flags = 0;
  555. err = mmc_send_cmd(mmc, &cmd, NULL);
  556. if (err)
  557. return err;
  558. if (IS_SD(mmc))
  559. err = sd_change_freq(mmc);
  560. else
  561. err = mmc_change_freq(mmc);
  562. if (err)
  563. return err;
  564. /* Restrict card's capabilities by what the host can do */
  565. mmc->card_caps &= mmc->host_caps;
  566. if (IS_SD(mmc)) {
  567. if (mmc->card_caps & MMC_MODE_4BIT) {
  568. cmd.cmdidx = MMC_CMD_APP_CMD;
  569. cmd.resp_type = MMC_RSP_R1;
  570. cmd.cmdarg = mmc->rca << 16;
  571. cmd.flags = 0;
  572. err = mmc_send_cmd(mmc, &cmd, NULL);
  573. if (err)
  574. return err;
  575. cmd.cmdidx = SD_CMD_APP_SET_BUS_WIDTH;
  576. cmd.resp_type = MMC_RSP_R1;
  577. cmd.cmdarg = 2;
  578. cmd.flags = 0;
  579. err = mmc_send_cmd(mmc, &cmd, NULL);
  580. if (err)
  581. return err;
  582. mmc_set_bus_width(mmc, 4);
  583. }
  584. if (mmc->card_caps & MMC_MODE_HS)
  585. mmc_set_clock(mmc, 50000000);
  586. else
  587. mmc_set_clock(mmc, 25000000);
  588. } else {
  589. if (mmc->card_caps & MMC_MODE_4BIT) {
  590. /* Set the card to use 4 bit*/
  591. err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
  592. EXT_CSD_BUS_WIDTH,
  593. EXT_CSD_BUS_WIDTH_4);
  594. if (err)
  595. return err;
  596. mmc_set_bus_width(mmc, 4);
  597. } else if (mmc->card_caps & MMC_MODE_8BIT) {
  598. /* Set the card to use 8 bit*/
  599. err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
  600. EXT_CSD_BUS_WIDTH,
  601. EXT_CSD_BUS_WIDTH_8);
  602. if (err)
  603. return err;
  604. mmc_set_bus_width(mmc, 8);
  605. }
  606. if (mmc->card_caps & MMC_MODE_HS) {
  607. if (mmc->card_caps & MMC_MODE_HS_52MHz)
  608. mmc_set_clock(mmc, 52000000);
  609. else
  610. mmc_set_clock(mmc, 26000000);
  611. } else
  612. mmc_set_clock(mmc, 20000000);
  613. }
  614. /* fill in device description */
  615. mmc->block_dev.lun = 0;
  616. mmc->block_dev.type = 0;
  617. mmc->block_dev.blksz = mmc->read_bl_len;
  618. mmc->block_dev.lba = lldiv(mmc->capacity, mmc->read_bl_len);
  619. sprintf(mmc->block_dev.vendor, "Man %06x Snr %08x", mmc->cid[0] >> 8,
  620. (mmc->cid[2] << 8) | (mmc->cid[3] >> 24));
  621. sprintf(mmc->block_dev.product, "%c%c%c%c%c", mmc->cid[0] & 0xff,
  622. (mmc->cid[1] >> 24), (mmc->cid[1] >> 16) & 0xff,
  623. (mmc->cid[1] >> 8) & 0xff, mmc->cid[1] & 0xff);
  624. sprintf(mmc->block_dev.revision, "%d.%d", mmc->cid[2] >> 28,
  625. (mmc->cid[2] >> 24) & 0xf);
  626. init_part(&mmc->block_dev);
  627. return 0;
  628. }
  629. int mmc_send_if_cond(struct mmc *mmc)
  630. {
  631. struct mmc_cmd cmd;
  632. int err;
  633. cmd.cmdidx = SD_CMD_SEND_IF_COND;
  634. /* We set the bit if the host supports voltages between 2.7 and 3.6 V */
  635. cmd.cmdarg = ((mmc->voltages & 0xff8000) != 0) << 8 | 0xaa;
  636. cmd.resp_type = MMC_RSP_R7;
  637. cmd.flags = 0;
  638. err = mmc_send_cmd(mmc, &cmd, NULL);
  639. if (err)
  640. return err;
  641. if ((cmd.response[0] & 0xff) != 0xaa)
  642. return UNUSABLE_ERR;
  643. else
  644. mmc->version = SD_VERSION_2;
  645. return 0;
  646. }
  647. int mmc_register(struct mmc *mmc)
  648. {
  649. /* Setup the universal parts of the block interface just once */
  650. mmc->block_dev.if_type = IF_TYPE_MMC;
  651. mmc->block_dev.dev = cur_dev_num++;
  652. mmc->block_dev.removable = 1;
  653. mmc->block_dev.block_read = mmc_bread;
  654. mmc->block_dev.block_write = mmc_bwrite;
  655. INIT_LIST_HEAD (&mmc->link);
  656. list_add_tail (&mmc->link, &mmc_devices);
  657. return 0;
  658. }
  659. block_dev_desc_t *mmc_get_dev(int dev)
  660. {
  661. struct mmc *mmc = find_mmc_device(dev);
  662. return mmc ? &mmc->block_dev : NULL;
  663. }
  664. int mmc_init(struct mmc *mmc)
  665. {
  666. int err;
  667. err = mmc->init(mmc);
  668. if (err)
  669. return err;
  670. mmc_set_bus_width(mmc, 1);
  671. mmc_set_clock(mmc, 1);
  672. /* Reset the Card */
  673. err = mmc_go_idle(mmc);
  674. if (err)
  675. return err;
  676. /* Test for SD version 2 */
  677. err = mmc_send_if_cond(mmc);
  678. /* Now try to get the SD card's operating condition */
  679. err = sd_send_op_cond(mmc);
  680. /* If the command timed out, we check for an MMC card */
  681. if (err == TIMEOUT) {
  682. err = mmc_send_op_cond(mmc);
  683. if (err) {
  684. printf("Card did not respond to voltage select!\n");
  685. return UNUSABLE_ERR;
  686. }
  687. }
  688. return mmc_startup(mmc);
  689. }
  690. /*
  691. * CPU and board-specific MMC initializations. Aliased function
  692. * signals caller to move on
  693. */
  694. static int __def_mmc_init(bd_t *bis)
  695. {
  696. return -1;
  697. }
  698. int cpu_mmc_init(bd_t *bis) __attribute__((weak, alias("__def_mmc_init")));
  699. int board_mmc_init(bd_t *bis) __attribute__((weak, alias("__def_mmc_init")));
  700. void print_mmc_devices(char separator)
  701. {
  702. struct mmc *m;
  703. struct list_head *entry;
  704. list_for_each(entry, &mmc_devices) {
  705. m = list_entry(entry, struct mmc, link);
  706. printf("%s: %d", m->name, m->block_dev.dev);
  707. if (entry->next != &mmc_devices)
  708. printf("%c ", separator);
  709. }
  710. printf("\n");
  711. }
  712. int mmc_initialize(bd_t *bis)
  713. {
  714. INIT_LIST_HEAD (&mmc_devices);
  715. cur_dev_num = 0;
  716. if (board_mmc_init(bis) < 0)
  717. cpu_mmc_init(bis);
  718. print_mmc_devices(',');
  719. return 0;
  720. }