2 * Copyright 2008, Freescale Semiconductor, Inc
5 * Based vaguely on the Linux code
7 * See file CREDITS for list of people who contributed to this
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.
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.
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,
32 #include <linux/list.h>
36 static struct list_head mmc_devices;
37 static int cur_dev_num = -1;
39 int mmc_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd, struct mmc_data *data)
41 return mmc->send_cmd(mmc, cmd, data);
44 int mmc_set_blocklen(struct mmc *mmc, int len)
48 cmd.cmdidx = MMC_CMD_SET_BLOCKLEN;
49 cmd.resp_type = MMC_RSP_R1;
53 return mmc_send_cmd(mmc, &cmd, NULL);
56 struct mmc *find_mmc_device(int dev_num)
59 struct list_head *entry;
61 list_for_each(entry, &mmc_devices) {
62 m = list_entry(entry, struct mmc, link);
64 if (m->block_dev.dev == dev_num)
68 printf("MMC Device %d not found\n", dev_num);
74 mmc_bwrite(int dev_num, ulong start, lbaint_t blkcnt, const void*src)
80 struct mmc *mmc = find_mmc_device(dev_num);
86 blklen = mmc->write_bl_len;
88 err = mmc_set_blocklen(mmc, mmc->write_bl_len);
91 printf("set write bl len failed\n\r");
96 cmd.cmdidx = MMC_CMD_WRITE_MULTIPLE_BLOCK;
98 cmd.cmdidx = MMC_CMD_WRITE_SINGLE_BLOCK;
100 if (mmc->high_capacity)
103 cmd.cmdarg = start * blklen;
105 cmd.resp_type = MMC_RSP_R1;
109 data.blocks = blkcnt;
110 data.blocksize = blklen;
111 data.flags = MMC_DATA_WRITE;
113 err = mmc_send_cmd(mmc, &cmd, &data);
116 printf("mmc write failed\n\r");
121 cmd.cmdidx = MMC_CMD_STOP_TRANSMISSION;
123 cmd.resp_type = MMC_RSP_R1b;
125 stoperr = mmc_send_cmd(mmc, &cmd, NULL);
131 int mmc_read_block(struct mmc *mmc, void *dst, uint blocknum)
134 struct mmc_data data;
136 cmd.cmdidx = MMC_CMD_READ_SINGLE_BLOCK;
138 if (mmc->high_capacity)
139 cmd.cmdarg = blocknum;
141 cmd.cmdarg = blocknum * mmc->read_bl_len;
143 cmd.resp_type = MMC_RSP_R1;
148 data.blocksize = mmc->read_bl_len;
149 data.flags = MMC_DATA_READ;
151 return mmc_send_cmd(mmc, &cmd, &data);
154 int mmc_read(struct mmc *mmc, u64 src, uchar *dst, int size)
158 int blklen = mmc->read_bl_len;
159 int startblock = lldiv(src, mmc->read_bl_len);
160 int endblock = lldiv(src + size - 1, mmc->read_bl_len);
163 /* Make a buffer big enough to hold all the blocks we might read */
164 buffer = malloc(blklen);
167 printf("Could not allocate buffer for MMC read!\n");
171 /* We always do full block reads from the card */
172 err = mmc_set_blocklen(mmc, mmc->read_bl_len);
177 for (i = startblock; i <= endblock; i++) {
181 err = mmc_read_block(mmc, buffer, i);
187 * The first block may not be aligned, so we
188 * copy from the desired point in the block
190 offset = (src & (blklen - 1));
191 segment_size = MIN(blklen - offset, size);
193 memcpy(dst, buffer + offset, segment_size);
197 size -= segment_size;
206 static ulong mmc_bread(int dev_num, ulong start, lbaint_t blkcnt, void *dst)
210 struct mmc *mmc = find_mmc_device(dev_num);
215 /* We always do full block reads from the card */
216 err = mmc_set_blocklen(mmc, mmc->read_bl_len);
222 for (i = start; i < start + blkcnt; i++, dst += mmc->read_bl_len) {
223 err = mmc_read_block(mmc, dst, i);
226 printf("block read failed: %d\n", err);
234 int mmc_go_idle(struct mmc* mmc)
241 cmd.cmdidx = MMC_CMD_GO_IDLE_STATE;
243 cmd.resp_type = MMC_RSP_NONE;
246 err = mmc_send_cmd(mmc, &cmd, NULL);
257 sd_send_op_cond(struct mmc *mmc)
264 cmd.cmdidx = MMC_CMD_APP_CMD;
265 cmd.resp_type = MMC_RSP_R1;
269 err = mmc_send_cmd(mmc, &cmd, NULL);
274 cmd.cmdidx = SD_CMD_APP_SEND_OP_COND;
275 cmd.resp_type = MMC_RSP_R3;
278 * Most cards do not answer if some reserved bits
279 * in the ocr are set. However, Some controller
280 * can set bit 7 (reserved for low voltages), but
281 * how to manage low voltages SD card is not yet
284 cmd.cmdarg = mmc->voltages & 0xff8000;
286 if (mmc->version == SD_VERSION_2)
287 cmd.cmdarg |= OCR_HCS;
289 err = mmc_send_cmd(mmc, &cmd, NULL);
295 } while ((!(cmd.response[0] & OCR_BUSY)) && timeout--);
300 if (mmc->version != SD_VERSION_2)
301 mmc->version = SD_VERSION_1_0;
303 mmc->ocr = cmd.response[0];
305 mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
311 int mmc_send_op_cond(struct mmc *mmc)
317 /* Some cards seem to need this */
321 cmd.cmdidx = MMC_CMD_SEND_OP_COND;
322 cmd.resp_type = MMC_RSP_R3;
323 cmd.cmdarg = OCR_HCS | mmc->voltages;
326 err = mmc_send_cmd(mmc, &cmd, NULL);
332 } while (!(cmd.response[0] & OCR_BUSY) && timeout--);
337 mmc->version = MMC_VERSION_UNKNOWN;
338 mmc->ocr = cmd.response[0];
340 mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
347 int mmc_send_ext_csd(struct mmc *mmc, char *ext_csd)
350 struct mmc_data data;
353 /* Get the Card Status Register */
354 cmd.cmdidx = MMC_CMD_SEND_EXT_CSD;
355 cmd.resp_type = MMC_RSP_R1;
361 data.blocksize = 512;
362 data.flags = MMC_DATA_READ;
364 err = mmc_send_cmd(mmc, &cmd, &data);
370 int mmc_switch(struct mmc *mmc, u8 set, u8 index, u8 value)
374 cmd.cmdidx = MMC_CMD_SWITCH;
375 cmd.resp_type = MMC_RSP_R1b;
376 cmd.cmdarg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
381 return mmc_send_cmd(mmc, &cmd, NULL);
384 int mmc_change_freq(struct mmc *mmc)
392 /* Only version 4 supports high-speed */
393 if (mmc->version < MMC_VERSION_4)
396 mmc->card_caps |= MMC_MODE_4BIT;
398 err = mmc_send_ext_csd(mmc, ext_csd);
403 if (ext_csd[212] || ext_csd[213] || ext_csd[214] || ext_csd[215])
404 mmc->high_capacity = 1;
406 cardtype = ext_csd[196] & 0xf;
408 err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_HS_TIMING, 1);
413 /* Now check to see that it worked */
414 err = mmc_send_ext_csd(mmc, ext_csd);
419 /* No high-speed support */
423 /* High Speed is set, there are two types: 52MHz and 26MHz */
424 if (cardtype & MMC_HS_52MHZ)
425 mmc->card_caps |= MMC_MODE_HS_52MHz | MMC_MODE_HS;
427 mmc->card_caps |= MMC_MODE_HS;
432 int sd_switch(struct mmc *mmc, int mode, int group, u8 value, u8 *resp)
435 struct mmc_data data;
437 /* Switch the frequency */
438 cmd.cmdidx = SD_CMD_SWITCH_FUNC;
439 cmd.resp_type = MMC_RSP_R1;
440 cmd.cmdarg = (mode << 31) | 0xffffff;
441 cmd.cmdarg &= ~(0xf << (group * 4));
442 cmd.cmdarg |= value << (group * 4);
445 data.dest = (char *)resp;
448 data.flags = MMC_DATA_READ;
450 return mmc_send_cmd(mmc, &cmd, &data);
454 int sd_change_freq(struct mmc *mmc)
459 uint switch_status[16];
460 struct mmc_data data;
465 /* Read the SCR to find out if this card supports higher speeds */
466 cmd.cmdidx = MMC_CMD_APP_CMD;
467 cmd.resp_type = MMC_RSP_R1;
468 cmd.cmdarg = mmc->rca << 16;
471 err = mmc_send_cmd(mmc, &cmd, NULL);
476 cmd.cmdidx = SD_CMD_APP_SEND_SCR;
477 cmd.resp_type = MMC_RSP_R1;
484 data.dest = (char *)&scr;
487 data.flags = MMC_DATA_READ;
489 err = mmc_send_cmd(mmc, &cmd, &data);
498 mmc->scr[0] = __be32_to_cpu(scr[0]);
499 mmc->scr[1] = __be32_to_cpu(scr[1]);
501 switch ((mmc->scr[0] >> 24) & 0xf) {
503 mmc->version = SD_VERSION_1_0;
506 mmc->version = SD_VERSION_1_10;
509 mmc->version = SD_VERSION_2;
512 mmc->version = SD_VERSION_1_0;
516 /* Version 1.0 doesn't support switching */
517 if (mmc->version == SD_VERSION_1_0)
522 err = sd_switch(mmc, SD_SWITCH_CHECK, 0, 1,
523 (u8 *)&switch_status);
528 /* The high-speed function is busy. Try again */
529 if (!(__be32_to_cpu(switch_status[7]) & SD_HIGHSPEED_BUSY))
533 if (mmc->scr[0] & SD_DATA_4BIT)
534 mmc->card_caps |= MMC_MODE_4BIT;
536 /* If high-speed isn't supported, we return */
537 if (!(__be32_to_cpu(switch_status[3]) & SD_HIGHSPEED_SUPPORTED))
540 err = sd_switch(mmc, SD_SWITCH_SWITCH, 0, 1, (u8 *)&switch_status);
545 if ((__be32_to_cpu(switch_status[4]) & 0x0f000000) == 0x01000000)
546 mmc->card_caps |= MMC_MODE_HS;
551 /* frequency bases */
552 /* divided by 10 to be nice to platforms without floating point */
560 /* Multiplier values for TRAN_SPEED. Multiplied by 10 to be nice
561 * to platforms without floating point.
563 int multipliers[] = {
582 void mmc_set_ios(struct mmc *mmc)
587 void mmc_set_clock(struct mmc *mmc, uint clock)
589 if (clock > mmc->f_max)
592 if (clock < mmc->f_min)
600 void mmc_set_bus_width(struct mmc *mmc, uint width)
602 mmc->bus_width = width;
607 int mmc_startup(struct mmc *mmc)
614 /* Put the Card in Identify Mode */
615 cmd.cmdidx = MMC_CMD_ALL_SEND_CID;
616 cmd.resp_type = MMC_RSP_R2;
620 err = mmc_send_cmd(mmc, &cmd, NULL);
625 memcpy(mmc->cid, cmd.response, 16);
628 * For MMC cards, set the Relative Address.
629 * For SD cards, get the Relatvie Address.
630 * This also puts the cards into Standby State
632 cmd.cmdidx = SD_CMD_SEND_RELATIVE_ADDR;
633 cmd.cmdarg = mmc->rca << 16;
634 cmd.resp_type = MMC_RSP_R6;
637 err = mmc_send_cmd(mmc, &cmd, NULL);
643 mmc->rca = (cmd.response[0] >> 16) & 0xffff;
645 /* Get the Card-Specific Data */
646 cmd.cmdidx = MMC_CMD_SEND_CSD;
647 cmd.resp_type = MMC_RSP_R2;
648 cmd.cmdarg = mmc->rca << 16;
651 err = mmc_send_cmd(mmc, &cmd, NULL);
656 mmc->csd[0] = cmd.response[0];
657 mmc->csd[1] = cmd.response[1];
658 mmc->csd[2] = cmd.response[2];
659 mmc->csd[3] = cmd.response[3];
661 if (mmc->version == MMC_VERSION_UNKNOWN) {
662 int version = (cmd.response[0] >> 26) & 0xf;
666 mmc->version = MMC_VERSION_1_2;
669 mmc->version = MMC_VERSION_1_4;
672 mmc->version = MMC_VERSION_2_2;
675 mmc->version = MMC_VERSION_3;
678 mmc->version = MMC_VERSION_4;
681 mmc->version = MMC_VERSION_1_2;
686 /* divide frequency by 10, since the mults are 10x bigger */
687 freq = fbase[(cmd.response[0] & 0x7)];
688 mult = multipliers[((cmd.response[0] >> 3) & 0xf)];
690 mmc->tran_speed = freq * mult;
692 mmc->read_bl_len = 1 << ((cmd.response[1] >> 16) & 0xf);
695 mmc->write_bl_len = mmc->read_bl_len;
697 mmc->write_bl_len = 1 << ((cmd.response[3] >> 22) & 0xf);
699 if (mmc->high_capacity) {
700 csize = (mmc->csd[1] & 0x3f) << 16
701 | (mmc->csd[2] & 0xffff0000) >> 16;
704 csize = (mmc->csd[1] & 0x3ff) << 2
705 | (mmc->csd[2] & 0xc0000000) >> 30;
706 cmult = (mmc->csd[2] & 0x00038000) >> 15;
709 mmc->capacity = (csize + 1) << (cmult + 2);
710 mmc->capacity *= mmc->read_bl_len;
712 if (mmc->read_bl_len > 512)
713 mmc->read_bl_len = 512;
715 if (mmc->write_bl_len > 512)
716 mmc->write_bl_len = 512;
718 /* Select the card, and put it into Transfer Mode */
719 cmd.cmdidx = MMC_CMD_SELECT_CARD;
720 cmd.resp_type = MMC_RSP_R1b;
721 cmd.cmdarg = mmc->rca << 16;
723 err = mmc_send_cmd(mmc, &cmd, NULL);
729 err = sd_change_freq(mmc);
731 err = mmc_change_freq(mmc);
736 /* Restrict card's capabilities by what the host can do */
737 mmc->card_caps &= mmc->host_caps;
740 if (mmc->card_caps & MMC_MODE_4BIT) {
741 cmd.cmdidx = MMC_CMD_APP_CMD;
742 cmd.resp_type = MMC_RSP_R1;
743 cmd.cmdarg = mmc->rca << 16;
746 err = mmc_send_cmd(mmc, &cmd, NULL);
750 cmd.cmdidx = SD_CMD_APP_SET_BUS_WIDTH;
751 cmd.resp_type = MMC_RSP_R1;
754 err = mmc_send_cmd(mmc, &cmd, NULL);
758 mmc_set_bus_width(mmc, 4);
761 if (mmc->card_caps & MMC_MODE_HS)
762 mmc_set_clock(mmc, 50000000);
764 mmc_set_clock(mmc, 25000000);
766 if (mmc->card_caps & MMC_MODE_4BIT) {
767 /* Set the card to use 4 bit*/
768 err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
770 EXT_CSD_BUS_WIDTH_4);
775 mmc_set_bus_width(mmc, 4);
776 } else if (mmc->card_caps & MMC_MODE_8BIT) {
777 /* Set the card to use 8 bit*/
778 err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
780 EXT_CSD_BUS_WIDTH_8);
785 mmc_set_bus_width(mmc, 8);
788 if (mmc->card_caps & MMC_MODE_HS) {
789 if (mmc->card_caps & MMC_MODE_HS_52MHz)
790 mmc_set_clock(mmc, 52000000);
792 mmc_set_clock(mmc, 26000000);
794 mmc_set_clock(mmc, 20000000);
797 /* fill in device description */
798 mmc->block_dev.lun = 0;
799 mmc->block_dev.type = 0;
800 mmc->block_dev.blksz = mmc->read_bl_len;
801 mmc->block_dev.lba = lldiv(mmc->capacity, mmc->read_bl_len);
802 sprintf(mmc->block_dev.vendor, "Man %06x Snr %08x", mmc->cid[0] >> 8,
803 (mmc->cid[2] << 8) | (mmc->cid[3] >> 24));
804 sprintf(mmc->block_dev.product, "%c%c%c%c%c", mmc->cid[0] & 0xff,
805 (mmc->cid[1] >> 24), (mmc->cid[1] >> 16) & 0xff,
806 (mmc->cid[1] >> 8) & 0xff, mmc->cid[1] & 0xff);
807 sprintf(mmc->block_dev.revision, "%d.%d", mmc->cid[2] >> 28,
808 (mmc->cid[2] >> 24) & 0xf);
809 init_part(&mmc->block_dev);
814 int mmc_send_if_cond(struct mmc *mmc)
819 cmd.cmdidx = SD_CMD_SEND_IF_COND;
820 /* We set the bit if the host supports voltages between 2.7 and 3.6 V */
821 cmd.cmdarg = ((mmc->voltages & 0xff8000) != 0) << 8 | 0xaa;
822 cmd.resp_type = MMC_RSP_R7;
825 err = mmc_send_cmd(mmc, &cmd, NULL);
830 if ((cmd.response[0] & 0xff) != 0xaa)
833 mmc->version = SD_VERSION_2;
838 int mmc_register(struct mmc *mmc)
840 /* Setup the universal parts of the block interface just once */
841 mmc->block_dev.if_type = IF_TYPE_MMC;
842 mmc->block_dev.dev = cur_dev_num++;
843 mmc->block_dev.removable = 1;
844 mmc->block_dev.block_read = mmc_bread;
845 mmc->block_dev.block_write = mmc_bwrite;
847 INIT_LIST_HEAD (&mmc->link);
849 list_add_tail (&mmc->link, &mmc_devices);
854 block_dev_desc_t *mmc_get_dev(int dev)
856 struct mmc *mmc = find_mmc_device(dev);
858 return mmc ? &mmc->block_dev : NULL;
861 int mmc_init(struct mmc *mmc)
865 err = mmc->init(mmc);
870 mmc_set_bus_width(mmc, 1);
871 mmc_set_clock(mmc, 1);
874 err = mmc_go_idle(mmc);
879 /* Test for SD version 2 */
880 err = mmc_send_if_cond(mmc);
882 /* Now try to get the SD card's operating condition */
883 err = sd_send_op_cond(mmc);
885 /* If the command timed out, we check for an MMC card */
886 if (err == TIMEOUT) {
887 err = mmc_send_op_cond(mmc);
890 printf("Card did not respond to voltage select!\n");
895 return mmc_startup(mmc);
899 * CPU and board-specific MMC initializations. Aliased function
900 * signals caller to move on
902 static int __def_mmc_init(bd_t *bis)
907 int cpu_mmc_init(bd_t *bis) __attribute__((weak, alias("__def_mmc_init")));
908 int board_mmc_init(bd_t *bis) __attribute__((weak, alias("__def_mmc_init")));
910 void print_mmc_devices(char separator)
913 struct list_head *entry;
915 list_for_each(entry, &mmc_devices) {
916 m = list_entry(entry, struct mmc, link);
918 printf("%s: %d", m->name, m->block_dev.dev);
920 if (entry->next != &mmc_devices)
921 printf("%c ", separator);
927 int mmc_initialize(bd_t *bis)
929 INIT_LIST_HEAD (&mmc_devices);
932 if (board_mmc_init(bis) < 0)
935 print_mmc_devices(',');