mmc.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931
  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. cmd.cmdarg = mmc->voltages;
  215. if (mmc->version == SD_VERSION_2)
  216. cmd.cmdarg |= OCR_HCS;
  217. err = mmc_send_cmd(mmc, &cmd, NULL);
  218. if (err)
  219. return err;
  220. udelay(1000);
  221. } while ((!(cmd.response[0] & OCR_BUSY)) && timeout--);
  222. if (timeout <= 0)
  223. return UNUSABLE_ERR;
  224. if (mmc->version != SD_VERSION_2)
  225. mmc->version = SD_VERSION_1_0;
  226. mmc->ocr = ((uint *)(cmd.response))[0];
  227. mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
  228. mmc->rca = 0;
  229. return 0;
  230. }
  231. int mmc_send_op_cond(struct mmc *mmc)
  232. {
  233. int timeout = 1000;
  234. struct mmc_cmd cmd;
  235. int err;
  236. /* Some cards seem to need this */
  237. mmc_go_idle(mmc);
  238. do {
  239. cmd.cmdidx = MMC_CMD_SEND_OP_COND;
  240. cmd.resp_type = MMC_RSP_R3;
  241. cmd.cmdarg = OCR_HCS | mmc->voltages;
  242. cmd.flags = 0;
  243. err = mmc_send_cmd(mmc, &cmd, NULL);
  244. if (err)
  245. return err;
  246. udelay(1000);
  247. } while (!(cmd.response[0] & OCR_BUSY) && timeout--);
  248. if (timeout <= 0)
  249. return UNUSABLE_ERR;
  250. mmc->version = MMC_VERSION_UNKNOWN;
  251. mmc->ocr = ((uint *)(cmd.response))[0];
  252. mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
  253. mmc->rca = 0;
  254. return 0;
  255. }
  256. int mmc_send_ext_csd(struct mmc *mmc, char *ext_csd)
  257. {
  258. struct mmc_cmd cmd;
  259. struct mmc_data data;
  260. int err;
  261. /* Get the Card Status Register */
  262. cmd.cmdidx = MMC_CMD_SEND_EXT_CSD;
  263. cmd.resp_type = MMC_RSP_R1;
  264. cmd.cmdarg = 0;
  265. cmd.flags = 0;
  266. data.dest = ext_csd;
  267. data.blocks = 1;
  268. data.blocksize = 512;
  269. data.flags = MMC_DATA_READ;
  270. err = mmc_send_cmd(mmc, &cmd, &data);
  271. return err;
  272. }
  273. int mmc_switch(struct mmc *mmc, u8 set, u8 index, u8 value)
  274. {
  275. struct mmc_cmd cmd;
  276. cmd.cmdidx = MMC_CMD_SWITCH;
  277. cmd.resp_type = MMC_RSP_R1b;
  278. cmd.cmdarg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
  279. (index << 16) |
  280. (value << 8);
  281. cmd.flags = 0;
  282. return mmc_send_cmd(mmc, &cmd, NULL);
  283. }
  284. int mmc_change_freq(struct mmc *mmc)
  285. {
  286. char ext_csd[512];
  287. char cardtype;
  288. int err;
  289. mmc->card_caps = 0;
  290. /* Only version 4 supports high-speed */
  291. if (mmc->version < MMC_VERSION_4)
  292. return 0;
  293. mmc->card_caps |= MMC_MODE_4BIT;
  294. err = mmc_send_ext_csd(mmc, ext_csd);
  295. if (err)
  296. return err;
  297. if (ext_csd[212] || ext_csd[213] || ext_csd[214] || ext_csd[215])
  298. mmc->high_capacity = 1;
  299. cardtype = ext_csd[196] & 0xf;
  300. err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_HS_TIMING, 1);
  301. if (err)
  302. return err;
  303. /* Now check to see that it worked */
  304. err = mmc_send_ext_csd(mmc, ext_csd);
  305. if (err)
  306. return err;
  307. /* No high-speed support */
  308. if (!ext_csd[185])
  309. return 0;
  310. /* High Speed is set, there are two types: 52MHz and 26MHz */
  311. if (cardtype & MMC_HS_52MHZ)
  312. mmc->card_caps |= MMC_MODE_HS_52MHz | MMC_MODE_HS;
  313. else
  314. mmc->card_caps |= MMC_MODE_HS;
  315. return 0;
  316. }
  317. int sd_switch(struct mmc *mmc, int mode, int group, u8 value, u8 *resp)
  318. {
  319. struct mmc_cmd cmd;
  320. struct mmc_data data;
  321. /* Switch the frequency */
  322. cmd.cmdidx = SD_CMD_SWITCH_FUNC;
  323. cmd.resp_type = MMC_RSP_R1;
  324. cmd.cmdarg = (mode << 31) | 0xffffff;
  325. cmd.cmdarg &= ~(0xf << (group * 4));
  326. cmd.cmdarg |= value << (group * 4);
  327. cmd.flags = 0;
  328. data.dest = (char *)resp;
  329. data.blocksize = 64;
  330. data.blocks = 1;
  331. data.flags = MMC_DATA_READ;
  332. return mmc_send_cmd(mmc, &cmd, &data);
  333. }
  334. int sd_change_freq(struct mmc *mmc)
  335. {
  336. int err;
  337. struct mmc_cmd cmd;
  338. uint scr[2];
  339. uint switch_status[16];
  340. struct mmc_data data;
  341. int timeout;
  342. mmc->card_caps = 0;
  343. /* Read the SCR to find out if this card supports higher speeds */
  344. cmd.cmdidx = MMC_CMD_APP_CMD;
  345. cmd.resp_type = MMC_RSP_R1;
  346. cmd.cmdarg = mmc->rca << 16;
  347. cmd.flags = 0;
  348. err = mmc_send_cmd(mmc, &cmd, NULL);
  349. if (err)
  350. return err;
  351. cmd.cmdidx = SD_CMD_APP_SEND_SCR;
  352. cmd.resp_type = MMC_RSP_R1;
  353. cmd.cmdarg = 0;
  354. cmd.flags = 0;
  355. timeout = 3;
  356. retry_scr:
  357. data.dest = (char *)&scr;
  358. data.blocksize = 8;
  359. data.blocks = 1;
  360. data.flags = MMC_DATA_READ;
  361. err = mmc_send_cmd(mmc, &cmd, &data);
  362. if (err) {
  363. if (timeout--)
  364. goto retry_scr;
  365. return err;
  366. }
  367. mmc->scr[0] = scr[0];
  368. mmc->scr[1] = scr[1];
  369. switch ((mmc->scr[0] >> 24) & 0xf) {
  370. case 0:
  371. mmc->version = SD_VERSION_1_0;
  372. break;
  373. case 1:
  374. mmc->version = SD_VERSION_1_10;
  375. break;
  376. case 2:
  377. mmc->version = SD_VERSION_2;
  378. break;
  379. default:
  380. mmc->version = SD_VERSION_1_0;
  381. break;
  382. }
  383. /* Version 1.0 doesn't support switching */
  384. if (mmc->version == SD_VERSION_1_0)
  385. return 0;
  386. timeout = 4;
  387. while (timeout--) {
  388. err = sd_switch(mmc, SD_SWITCH_CHECK, 0, 1,
  389. (u8 *)&switch_status);
  390. if (err)
  391. return err;
  392. /* The high-speed function is busy. Try again */
  393. if (!switch_status[7] & SD_HIGHSPEED_BUSY)
  394. break;
  395. }
  396. if (mmc->scr[0] & SD_DATA_4BIT)
  397. mmc->card_caps |= MMC_MODE_4BIT;
  398. /* If high-speed isn't supported, we return */
  399. if (!(switch_status[3] & SD_HIGHSPEED_SUPPORTED))
  400. return 0;
  401. err = sd_switch(mmc, SD_SWITCH_SWITCH, 0, 1, (u8 *)&switch_status);
  402. if (err)
  403. return err;
  404. if ((switch_status[4] & 0x0f000000) == 0x01000000)
  405. mmc->card_caps |= MMC_MODE_HS;
  406. return 0;
  407. }
  408. /* frequency bases */
  409. /* divided by 10 to be nice to platforms without floating point */
  410. int fbase[] = {
  411. 10000,
  412. 100000,
  413. 1000000,
  414. 10000000,
  415. };
  416. /* Multiplier values for TRAN_SPEED. Multiplied by 10 to be nice
  417. * to platforms without floating point.
  418. */
  419. int multipliers[] = {
  420. 0, /* reserved */
  421. 10,
  422. 12,
  423. 13,
  424. 15,
  425. 20,
  426. 25,
  427. 30,
  428. 35,
  429. 40,
  430. 45,
  431. 50,
  432. 55,
  433. 60,
  434. 70,
  435. 80,
  436. };
  437. void mmc_set_ios(struct mmc *mmc)
  438. {
  439. mmc->set_ios(mmc);
  440. }
  441. void mmc_set_clock(struct mmc *mmc, uint clock)
  442. {
  443. if (clock > mmc->f_max)
  444. clock = mmc->f_max;
  445. if (clock < mmc->f_min)
  446. clock = mmc->f_min;
  447. mmc->clock = clock;
  448. mmc_set_ios(mmc);
  449. }
  450. void mmc_set_bus_width(struct mmc *mmc, uint width)
  451. {
  452. mmc->bus_width = width;
  453. mmc_set_ios(mmc);
  454. }
  455. int mmc_startup(struct mmc *mmc)
  456. {
  457. int err;
  458. uint mult, freq;
  459. u64 cmult, csize;
  460. struct mmc_cmd cmd;
  461. /* Put the Card in Identify Mode */
  462. cmd.cmdidx = MMC_CMD_ALL_SEND_CID;
  463. cmd.resp_type = MMC_RSP_R2;
  464. cmd.cmdarg = 0;
  465. cmd.flags = 0;
  466. err = mmc_send_cmd(mmc, &cmd, NULL);
  467. if (err)
  468. return err;
  469. memcpy(mmc->cid, cmd.response, 16);
  470. /*
  471. * For MMC cards, set the Relative Address.
  472. * For SD cards, get the Relatvie Address.
  473. * This also puts the cards into Standby State
  474. */
  475. cmd.cmdidx = SD_CMD_SEND_RELATIVE_ADDR;
  476. cmd.cmdarg = mmc->rca << 16;
  477. cmd.resp_type = MMC_RSP_R6;
  478. cmd.flags = 0;
  479. err = mmc_send_cmd(mmc, &cmd, NULL);
  480. if (err)
  481. return err;
  482. if (IS_SD(mmc))
  483. mmc->rca = (((uint *)(cmd.response))[0] >> 16) & 0xffff;
  484. /* Get the Card-Specific Data */
  485. cmd.cmdidx = MMC_CMD_SEND_CSD;
  486. cmd.resp_type = MMC_RSP_R2;
  487. cmd.cmdarg = mmc->rca << 16;
  488. cmd.flags = 0;
  489. err = mmc_send_cmd(mmc, &cmd, NULL);
  490. if (err)
  491. return err;
  492. mmc->csd[0] = ((uint *)(cmd.response))[0];
  493. mmc->csd[1] = ((uint *)(cmd.response))[1];
  494. mmc->csd[2] = ((uint *)(cmd.response))[2];
  495. mmc->csd[3] = ((uint *)(cmd.response))[3];
  496. if (mmc->version == MMC_VERSION_UNKNOWN) {
  497. int version = (cmd.response[0] >> 26) & 0xf;
  498. switch (version) {
  499. case 0:
  500. mmc->version = MMC_VERSION_1_2;
  501. break;
  502. case 1:
  503. mmc->version = MMC_VERSION_1_4;
  504. break;
  505. case 2:
  506. mmc->version = MMC_VERSION_2_2;
  507. break;
  508. case 3:
  509. mmc->version = MMC_VERSION_3;
  510. break;
  511. case 4:
  512. mmc->version = MMC_VERSION_4;
  513. break;
  514. default:
  515. mmc->version = MMC_VERSION_1_2;
  516. break;
  517. }
  518. }
  519. /* divide frequency by 10, since the mults are 10x bigger */
  520. freq = fbase[(cmd.response[0] & 0x7)];
  521. mult = multipliers[((cmd.response[0] >> 3) & 0xf)];
  522. mmc->tran_speed = freq * mult;
  523. mmc->read_bl_len = 1 << ((((uint *)(cmd.response))[1] >> 16) & 0xf);
  524. if (IS_SD(mmc))
  525. mmc->write_bl_len = mmc->read_bl_len;
  526. else
  527. mmc->write_bl_len = 1 << ((((uint *)(cmd.response))[3] >> 22) & 0xf);
  528. if (mmc->high_capacity) {
  529. csize = (mmc->csd[1] & 0x3f) << 16
  530. | (mmc->csd[2] & 0xffff0000) >> 16;
  531. cmult = 8;
  532. } else {
  533. csize = (mmc->csd[1] & 0x3ff) << 2
  534. | (mmc->csd[2] & 0xc0000000) >> 30;
  535. cmult = (mmc->csd[2] & 0x00038000) >> 15;
  536. }
  537. mmc->capacity = (csize + 1) << (cmult + 2);
  538. mmc->capacity *= mmc->read_bl_len;
  539. if (mmc->read_bl_len > 512)
  540. mmc->read_bl_len = 512;
  541. if (mmc->write_bl_len > 512)
  542. mmc->write_bl_len = 512;
  543. /* Select the card, and put it into Transfer Mode */
  544. cmd.cmdidx = MMC_CMD_SELECT_CARD;
  545. cmd.resp_type = MMC_RSP_R1b;
  546. cmd.cmdarg = mmc->rca << 16;
  547. cmd.flags = 0;
  548. err = mmc_send_cmd(mmc, &cmd, NULL);
  549. if (err)
  550. return err;
  551. if (IS_SD(mmc))
  552. err = sd_change_freq(mmc);
  553. else
  554. err = mmc_change_freq(mmc);
  555. if (err)
  556. return err;
  557. /* Restrict card's capabilities by what the host can do */
  558. mmc->card_caps &= mmc->host_caps;
  559. if (IS_SD(mmc)) {
  560. if (mmc->card_caps & MMC_MODE_4BIT) {
  561. cmd.cmdidx = MMC_CMD_APP_CMD;
  562. cmd.resp_type = MMC_RSP_R1;
  563. cmd.cmdarg = mmc->rca << 16;
  564. cmd.flags = 0;
  565. err = mmc_send_cmd(mmc, &cmd, NULL);
  566. if (err)
  567. return err;
  568. cmd.cmdidx = SD_CMD_APP_SET_BUS_WIDTH;
  569. cmd.resp_type = MMC_RSP_R1;
  570. cmd.cmdarg = 2;
  571. cmd.flags = 0;
  572. err = mmc_send_cmd(mmc, &cmd, NULL);
  573. if (err)
  574. return err;
  575. mmc_set_bus_width(mmc, 4);
  576. }
  577. if (mmc->card_caps & MMC_MODE_HS)
  578. mmc_set_clock(mmc, 50000000);
  579. else
  580. mmc_set_clock(mmc, 25000000);
  581. } else {
  582. if (mmc->card_caps & MMC_MODE_4BIT) {
  583. /* Set the card to use 4 bit*/
  584. err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
  585. EXT_CSD_BUS_WIDTH,
  586. EXT_CSD_BUS_WIDTH_4);
  587. if (err)
  588. return err;
  589. mmc_set_bus_width(mmc, 4);
  590. } else if (mmc->card_caps & MMC_MODE_8BIT) {
  591. /* Set the card to use 8 bit*/
  592. err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
  593. EXT_CSD_BUS_WIDTH,
  594. EXT_CSD_BUS_WIDTH_8);
  595. if (err)
  596. return err;
  597. mmc_set_bus_width(mmc, 8);
  598. }
  599. if (mmc->card_caps & MMC_MODE_HS) {
  600. if (mmc->card_caps & MMC_MODE_HS_52MHz)
  601. mmc_set_clock(mmc, 52000000);
  602. else
  603. mmc_set_clock(mmc, 26000000);
  604. } else
  605. mmc_set_clock(mmc, 20000000);
  606. }
  607. /* fill in device description */
  608. mmc->block_dev.lun = 0;
  609. mmc->block_dev.type = 0;
  610. mmc->block_dev.blksz = mmc->read_bl_len;
  611. mmc->block_dev.lba = lldiv(mmc->capacity, mmc->read_bl_len);
  612. sprintf(mmc->block_dev.vendor, "Man %06x Snr %08x", mmc->cid[0] >> 8,
  613. (mmc->cid[2] << 8) | (mmc->cid[3] >> 24));
  614. sprintf(mmc->block_dev.product, "%c%c%c%c%c", mmc->cid[0] & 0xff,
  615. (mmc->cid[1] >> 24), (mmc->cid[1] >> 16) & 0xff,
  616. (mmc->cid[1] >> 8) & 0xff, mmc->cid[1] & 0xff);
  617. sprintf(mmc->block_dev.revision, "%d.%d", mmc->cid[2] >> 28,
  618. (mmc->cid[2] >> 24) & 0xf);
  619. init_part(&mmc->block_dev);
  620. return 0;
  621. }
  622. int mmc_send_if_cond(struct mmc *mmc)
  623. {
  624. struct mmc_cmd cmd;
  625. int err;
  626. cmd.cmdidx = SD_CMD_SEND_IF_COND;
  627. /* We set the bit if the host supports voltages between 2.7 and 3.6 V */
  628. cmd.cmdarg = ((mmc->voltages & 0xff8000) != 0) << 8 | 0xaa;
  629. cmd.resp_type = MMC_RSP_R7;
  630. cmd.flags = 0;
  631. err = mmc_send_cmd(mmc, &cmd, NULL);
  632. if (err)
  633. return err;
  634. if ((((uint *)(cmd.response))[0] & 0xff) != 0xaa)
  635. return UNUSABLE_ERR;
  636. else
  637. mmc->version = SD_VERSION_2;
  638. return 0;
  639. }
  640. int mmc_register(struct mmc *mmc)
  641. {
  642. /* Setup the universal parts of the block interface just once */
  643. mmc->block_dev.if_type = IF_TYPE_MMC;
  644. mmc->block_dev.dev = cur_dev_num++;
  645. mmc->block_dev.removable = 1;
  646. mmc->block_dev.block_read = mmc_bread;
  647. mmc->block_dev.block_write = mmc_bwrite;
  648. INIT_LIST_HEAD (&mmc->link);
  649. list_add_tail (&mmc->link, &mmc_devices);
  650. return 0;
  651. }
  652. block_dev_desc_t *mmc_get_dev(int dev)
  653. {
  654. struct mmc *mmc = find_mmc_device(dev);
  655. return mmc ? &mmc->block_dev : NULL;
  656. }
  657. int mmc_init(struct mmc *mmc)
  658. {
  659. int err;
  660. err = mmc->init(mmc);
  661. if (err)
  662. return err;
  663. /* Reset the Card */
  664. err = mmc_go_idle(mmc);
  665. if (err)
  666. return err;
  667. /* Test for SD version 2 */
  668. err = mmc_send_if_cond(mmc);
  669. /* If we got an error other than timeout, we bail */
  670. if (err && err != TIMEOUT)
  671. return err;
  672. /* Now try to get the SD card's operating condition */
  673. err = sd_send_op_cond(mmc);
  674. /* If the command timed out, we check for an MMC card */
  675. if (err == TIMEOUT) {
  676. err = mmc_send_op_cond(mmc);
  677. if (err) {
  678. printf("Card did not respond to voltage select!\n");
  679. return UNUSABLE_ERR;
  680. }
  681. }
  682. return mmc_startup(mmc);
  683. }
  684. /*
  685. * CPU and board-specific MMC initializations. Aliased function
  686. * signals caller to move on
  687. */
  688. static int __def_mmc_init(bd_t *bis)
  689. {
  690. return -1;
  691. }
  692. int cpu_mmc_init(bd_t *bis) __attribute__((weak, alias("__def_mmc_init")));
  693. int board_mmc_init(bd_t *bis) __attribute__((weak, alias("__def_mmc_init")));
  694. void print_mmc_devices(char separator)
  695. {
  696. struct mmc *m;
  697. struct list_head *entry;
  698. list_for_each(entry, &mmc_devices) {
  699. m = list_entry(entry, struct mmc, link);
  700. printf("%s: %d", m->name, m->block_dev.dev);
  701. if (entry->next != &mmc_devices)
  702. printf("%c ", separator);
  703. }
  704. printf("\n");
  705. }
  706. int mmc_initialize(bd_t *bis)
  707. {
  708. INIT_LIST_HEAD (&mmc_devices);
  709. cur_dev_num = 0;
  710. if (board_mmc_init(bis) < 0)
  711. cpu_mmc_init(bis);
  712. print_mmc_devices(',');
  713. return 0;
  714. }