1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771 |
- /*
- * Copyright 2008, Freescale Semiconductor, Inc
- * Andy Fleming
- *
- * Based vaguely on the Linux code
- *
- * SPDX-License-Identifier: GPL-2.0+
- */
- #include <comdef.h>
- #include <mmc.h>
- #include <uart.h>
- #include <sys.h>
- #include <timer.h>
- #include "mmc_private.h"
- #include "util.h"
- #include "sizes.h"
- #include "errno.h"
- extern struct mmc local_mmc0;
- static int cur_dev_num = -1;
- const char *mmc_mode_name(enum bus_mode mode)
- {
- static const char *const names[] = {
- [MMC_LEGACY] = "MMC legacy",
- [SD_LEGACY] = "SD Legacy",
- [MMC_HS] = "MMC High Speed (26MHz)",
- [SD_HS] = "SD High Speed (50MHz)",
- [UHS_SDR12] = "UHS SDR12 (25MHz)",
- [UHS_SDR25] = "UHS SDR25 (50MHz)",
- [UHS_SDR50] = "UHS SDR50 (100MHz)",
- [UHS_SDR104] = "UHS SDR104 (208MHz)",
- [UHS_DDR50] = "UHS DDR50 (50MHz)",
- [MMC_HS_52] = "MMC High Speed (52MHz)",
- [MMC_DDR_52] = "MMC DDR52 (52MHz)",
- [MMC_HS_200] = "HS200 (200MHz)",
- };
- if (mode >= MMC_MODES_END)
- return "Unknown mode";
- else
- return names[mode];
- }
- static u32 mmc_mode2freq(struct mmc *mmc, enum bus_mode mode)
- {
- static const int freqs[] = {
- [MMC_LEGACY] = 25000000,
- [SD_LEGACY] = 25000000,
- [MMC_HS] = 26000000,
- [SD_HS] = 50000000,
- [MMC_HS_52] = 52000000,
- [MMC_DDR_52] = 52000000,
- [UHS_SDR12] = 25000000,
- [UHS_SDR25] = 50000000,
- [UHS_SDR50] = 100000000,
- [UHS_DDR50] = 50000000,
- [UHS_SDR104] = 208000000,
- [MMC_HS_200] = 200000000,
- };
- if (mode == MMC_LEGACY)
- return mmc->legacy_speed;
- else if (mode >= MMC_MODES_END)
- return 0;
- else
- return freqs[mode];
- }
- static int mmc_select_mode(struct mmc *mmc, enum bus_mode mode)
- {
- mmc->selected_mode = mode;
- mmc->tran_speed = mmc_mode2freq(mmc, mode);
- mmc->ddr_mode = mmc_is_mode_ddr(mode);
- // printk("selecting mode %s (freq : %d MHz)\n", mmc_mode_name(mode),
- // mmc->tran_speed / 1000000);
- return 0;
- }
- int mmc_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd, struct mmc_data *data)
- {
- int ret;
- ret = mmc->cfg->ops->send_cmd(mmc, cmd, data);
- return ret;
- }
- int mmc_send_status(struct mmc *mmc, int timeout)
- {
- struct mmc_cmd cmd;
- int err, retries = 5;
- cmd.cmdidx = MMC_CMD_SEND_STATUS;
- cmd.resp_type = MMC_RSP_R1;
- if (!mmc_host_is_spi(mmc))
- cmd.cmdarg = mmc->rca << 16;
- while (1) {
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (!err) {
- if ((cmd.response[0] & MMC_STATUS_RDY_FOR_DATA) &&
- (cmd.response[0] & MMC_STATUS_CURR_STATE) !=
- MMC_STATE_PRG)
- break;
- else if (cmd.response[0] & MMC_STATUS_MASK) {
- return -ECOMM;
- }
- } else if (--retries < 0)
- return err;
- if (timeout-- <= 0)
- break;
- udelay(100);
- }
- if (timeout <= 0) {
- return -ETIMEDOUT;
- }
- return 0;
- }
- int mmc_set_blocklen(struct mmc *mmc, int len)
- {
- struct mmc_cmd cmd;
- if (mmc->ddr_mode)
- return 0;
- cmd.cmdidx = MMC_CMD_SET_BLOCKLEN;
- cmd.resp_type = MMC_RSP_R1;
- cmd.cmdarg = len;
- return mmc_send_cmd(mmc, &cmd, NULL);
- }
- static int mmc_read_blocks(struct mmc *mmc, void *dst, unsigned long start,
- unsigned long blkcnt)
- {
- struct mmc_cmd cmd;
- struct mmc_data data;
- if (blkcnt > 1)
- cmd.cmdidx = MMC_CMD_READ_MULTIPLE_BLOCK;
- else
- cmd.cmdidx = MMC_CMD_READ_SINGLE_BLOCK;
- if (mmc->high_capacity)
- cmd.cmdarg = start;
- else
- cmd.cmdarg = start * mmc->read_bl_len;
- cmd.resp_type = MMC_RSP_R1;
- data.dest = dst;
- data.blocks = blkcnt;
- data.blocksize = mmc->read_bl_len;
- data.flags = MMC_DATA_READ;
- if (mmc_send_cmd(mmc, &cmd, &data))
- return 0;
- if (blkcnt > 1) {
- cmd.cmdidx = MMC_CMD_STOP_TRANSMISSION;
- cmd.cmdarg = 0;
- cmd.resp_type = MMC_RSP_R1b;
- if (mmc_send_cmd(mmc, &cmd, NULL)) {
- return 0;
- }
- }
- return blkcnt;
- }
- static unsigned long mmc_bread(int dev_num, unsigned long start, unsigned long blkcnt, void *dst)
- {
- unsigned long cur, blocks_todo = blkcnt;
- struct mmc *mmc;
- if (blkcnt == 0)
- return 0;
- if(dev_num == 0)
- mmc = &local_mmc0;
- if (!mmc)
- return 0;
- if ((start + blkcnt) > mmc->block_dev.lba) {
- return 0;
- }
- if (mmc_set_blocklen(mmc, mmc->read_bl_len)) {
- return 0;
- }
- do {
- cur = (blocks_todo > mmc->cfg->b_max) ?
- mmc->cfg->b_max : blocks_todo;
- if (mmc_read_blocks(mmc, dst, start, cur) != cur) {
- return 0;
- }
- blocks_todo -= cur;
- start += cur;
- dst += cur * mmc->read_bl_len;
- } while (blocks_todo > 0);
- return blkcnt;
- }
- static int mmc_go_idle(struct mmc *mmc)
- {
- struct mmc_cmd cmd;
- int err;
- udelay(100);
- cmd.cmdidx = MMC_CMD_GO_IDLE_STATE;
- cmd.cmdarg = 0;
- cmd.resp_type = MMC_RSP_NONE;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- udelay(200);
- return 0;
- }
- static int sd_send_op_cond(struct mmc *mmc, bool uhs_en)
- {
- int timeout = 1000;
- int err;
- struct mmc_cmd cmd;
- while (1) {
- cmd.cmdidx = MMC_CMD_APP_CMD;
- cmd.resp_type = MMC_RSP_R1;
- cmd.cmdarg = 0;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- cmd.cmdidx = SD_CMD_APP_SEND_OP_COND;
- cmd.resp_type = MMC_RSP_R3;
- /*
- * Most cards do not answer if some reserved bits
- * in the ocr are set. However, Some controller
- * can set bit 7 (reserved for low voltages), but
- * how to manage low voltages SD card is not yet
- * specified.
- */
- cmd.cmdarg = mmc_host_is_spi(mmc) ? 0 :
- (mmc->cfg->voltages & 0xff8000);
- if (mmc->version == SD_VERSION_2)
- cmd.cmdarg |= OCR_HCS;
- if (uhs_en)
- cmd.cmdarg |= OCR_S18R;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- if (cmd.response[0] & OCR_BUSY)
- break;
- if (timeout-- <= 0)
- return -EOPNOTSUPP;
- udelay(1000);
- }
- if (mmc->version != SD_VERSION_2)
- mmc->version = SD_VERSION_1_0;
- if (mmc_host_is_spi(mmc)) { /* read OCR for spi */
- cmd.cmdidx = MMC_CMD_SPI_READ_OCR;
- cmd.resp_type = MMC_RSP_R3;
- cmd.cmdarg = 0;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- }
- mmc->ocr = cmd.response[0];
- mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
- mmc->rca = 0;
- return 0;
- }
- static int mmc_send_op_cond_iter(struct mmc *mmc, int use_arg)
- {
- struct mmc_cmd cmd;
- int err;
- cmd.cmdidx = MMC_CMD_SEND_OP_COND;
- cmd.resp_type = MMC_RSP_R3;
- cmd.cmdarg = 0;
- if (use_arg && !mmc_host_is_spi(mmc))
- cmd.cmdarg = OCR_HCS |
- (mmc->cfg->voltages &
- (mmc->ocr & OCR_VOLTAGE_MASK)) |
- (mmc->ocr & OCR_ACCESS_MODE);
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- mmc->ocr = cmd.response[0];
- return 0;
- }
- static int mmc_send_op_cond(struct mmc *mmc)
- {
- int err, i;
- /* Some cards seem to need this */
- mmc_go_idle(mmc);
- /* Asking to the card its capabilities */
- for (i = 0; i < 2; i++) {
- err = mmc_send_op_cond_iter(mmc, i != 0);
- if (err)
- return err;
- /* exit if not busy (flag seems to be inverted) */
- if (mmc->ocr & OCR_BUSY)
- break;
- }
- mmc->op_cond_pending = 1;
- return 0;
- }
- static int mmc_complete_op_cond(struct mmc *mmc)
- {
- struct mmc_cmd cmd;
- int timeout = 1000;
- u64 start;
- int err;
- mmc->op_cond_pending = 0;
- if (!(mmc->ocr & OCR_BUSY)) {
- /* Some cards seem to need this */
- mmc_go_idle(mmc);
- start = get_timer(0);
- while (1) {
- err = mmc_send_op_cond_iter(mmc, 1);
- if (err)
- return err;
- if (mmc->ocr & OCR_BUSY)
- break;
- if (get_timer(start) > timeout)
- return -EOPNOTSUPP;
- udelay(100);
- }
- }
- if (mmc_host_is_spi(mmc)) { /* read OCR for spi */
- cmd.cmdidx = MMC_CMD_SPI_READ_OCR;
- cmd.resp_type = MMC_RSP_R3;
- cmd.cmdarg = 0;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- mmc->ocr = cmd.response[0];
- }
- mmc->version = MMC_VERSION_UNKNOWN;
- mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
- mmc->rca = 1;
- return 0;
- }
- static int mmc_send_ext_csd(struct mmc *mmc, u8 *ext_csd)
- {
- struct mmc_cmd cmd;
- struct mmc_data data;
- int err;
- /* Get the Card Status Register */
- cmd.cmdidx = MMC_CMD_SEND_EXT_CSD;
- cmd.resp_type = MMC_RSP_R1;
- cmd.cmdarg = 0;
- data.dest = (char *)ext_csd;
- data.blocks = 1;
- data.blocksize = MMC_MAX_BLOCK_LEN;
- data.flags = MMC_DATA_READ;
- err = mmc_send_cmd(mmc, &cmd, &data);
- return err;
- }
- static int mmc_switch(struct mmc *mmc, u8 set, u8 index, u8 value)
- {
- struct mmc_cmd cmd;
- int timeout = 1000;
- int retries = 3;
- int ret;
- cmd.cmdidx = MMC_CMD_SWITCH;
- cmd.resp_type = MMC_RSP_R1b;
- cmd.cmdarg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
- (index << 16) |
- (value << 8);
- while (retries > 0) {
- ret = mmc_send_cmd(mmc, &cmd, NULL);
- /* Waiting for the ready status */
- if (!ret) {
- ret = mmc_send_status(mmc, timeout);
- return ret;
- }
- retries--;
- }
- return ret;
- }
- static int mmc_set_card_speed(struct mmc *mmc, enum bus_mode mode)
- {
- int err;
- int speed_bits;
- ALLOC_CACHE_ALIGN_BUFFER(u8, test_csd, MMC_MAX_BLOCK_LEN);
- switch (mode) {
- case MMC_HS:
- case MMC_HS_52:
- case MMC_DDR_52:
- speed_bits = EXT_CSD_TIMING_HS;
- break;
- case MMC_LEGACY:
- speed_bits = EXT_CSD_TIMING_LEGACY;
- break;
- default:
- return -EINVAL;
- }
- err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_HS_TIMING,
- speed_bits);
- if (err)
- return err;
- if ((mode == MMC_HS) || (mode == MMC_HS_52)) {
- /* Now check to see that it worked */
- err = mmc_send_ext_csd(mmc, test_csd);
- if (err)
- return err;
- /* No high-speed support */
- if (!test_csd[EXT_CSD_HS_TIMING])
- return -ENOTSUPP;
- }
- return 0;
- }
- static int mmc_get_capabilities(struct mmc *mmc)
- {
- u8 *ext_csd = mmc->ext_csd;
- char cardtype;
- mmc->card_caps = MMC_MODE_1BIT | MMC_CAP(MMC_LEGACY);
- if (mmc_host_is_spi(mmc))
- return 0;
- /* Only version 4 supports high-speed */
- if (mmc->version < MMC_VERSION_4)
- return 0;
- if (!ext_csd) {
- printk("No ext_csd found!\n"); /* this should enver happen */
- return -ENOTSUPP;
- }
- mmc->card_caps |= MMC_MODE_4BIT | MMC_MODE_8BIT;
- cardtype = ext_csd[EXT_CSD_CARD_TYPE] & 0x3f;
- mmc->cardtype = cardtype;
- if (cardtype & EXT_CSD_CARD_TYPE_52) {
- if (cardtype & EXT_CSD_CARD_TYPE_DDR_52)
- mmc->card_caps |= MMC_MODE_DDR_52MHz;
- mmc->card_caps |= MMC_MODE_HS_52MHz;
- }
- if (cardtype & EXT_CSD_CARD_TYPE_26)
- mmc->card_caps |= MMC_MODE_HS;
- return 0;
- }
- static int mmc_set_capacity(struct mmc *mmc, int part_num)
- {
- switch (part_num) {
- case 0:
- mmc->capacity = mmc->capacity_user;
- break;
- case 1:
- case 2:
- mmc->capacity = mmc->capacity_boot;
- break;
- case 3:
- mmc->capacity = mmc->capacity_rpmb;
- break;
- case 4:
- case 5:
- case 6:
- case 7:
- mmc->capacity = mmc->capacity_gp[part_num - 4];
- break;
- default:
- return -1;
- }
- mmc->block_dev.lba = lldiv(mmc->capacity, mmc->read_bl_len);
- return 0;
- }
- static inline int bus_width(u32 cap)
- {
- if (cap == MMC_MODE_8BIT)
- return 8;
- if (cap == MMC_MODE_4BIT)
- return 4;
- if (cap == MMC_MODE_1BIT)
- return 1;
- printk("invalid bus witdh capability 0x%x\n", cap);
- return 0;
- }
- static int sd_switch(struct mmc *mmc, int mode, int group, u8 value, u8 *resp)
- {
- struct mmc_cmd cmd;
- struct mmc_data data;
- /* Switch the frequency */
- cmd.cmdidx = SD_CMD_SWITCH_FUNC;
- cmd.resp_type = MMC_RSP_R1;
- cmd.cmdarg = (mode << 31) | 0xffffff;
- cmd.cmdarg &= ~(0xf << (group * 4));
- cmd.cmdarg |= value << (group * 4);
- data.dest = (char *)resp;
- data.blocksize = 64;
- data.blocks = 1;
- data.flags = MMC_DATA_READ;
- return mmc_send_cmd(mmc, &cmd, &data);
- }
- static int sd_get_capabilities(struct mmc *mmc)
- {
- int err;
- struct mmc_cmd cmd;
- ALLOC_CACHE_ALIGN_BUFFER(u32, scr, 2);
- ALLOC_CACHE_ALIGN_BUFFER(u32, switch_status, 16);
- struct mmc_data data;
- int timeout;
- mmc->card_caps = MMC_MODE_1BIT | MMC_CAP(SD_LEGACY);
- if (mmc_host_is_spi(mmc))
- return 0;
- /* Read the SCR to find out if this card supports higher speeds */
- cmd.cmdidx = MMC_CMD_APP_CMD;
- cmd.resp_type = MMC_RSP_R1;
- cmd.cmdarg = mmc->rca << 16;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- cmd.cmdidx = SD_CMD_APP_SEND_SCR;
- cmd.resp_type = MMC_RSP_R1;
- cmd.cmdarg = 0;
- timeout = 3;
- retry_scr:
- data.dest = (char *)scr;
- data.blocksize = 8;
- data.blocks = 1;
- data.flags = MMC_DATA_READ;
- err = mmc_send_cmd(mmc, &cmd, &data);
- if (err) {
- if (timeout--)
- goto retry_scr;
- return err;
- }
- mmc->scr[0] = __be32_to_cpu(scr[0]);
- mmc->scr[1] = __be32_to_cpu(scr[1]);
- switch ((mmc->scr[0] >> 24) & 0xf) {
- case 0:
- mmc->version = SD_VERSION_1_0;
- break;
- case 1:
- mmc->version = SD_VERSION_1_10;
- break;
- case 2:
- mmc->version = SD_VERSION_2;
- if ((mmc->scr[0] >> 15) & 0x1)
- mmc->version = SD_VERSION_3;
- break;
- default:
- mmc->version = SD_VERSION_1_0;
- break;
- }
- if (mmc->scr[0] & SD_DATA_4BIT)
- mmc->card_caps |= MMC_MODE_4BIT;
- /* Version 1.0 doesn't support switching */
- if (mmc->version == SD_VERSION_1_0)
- return 0;
- timeout = 4;
- while (timeout--) {
- err = sd_switch(mmc, SD_SWITCH_CHECK, 0, 1,
- (u8 *)switch_status);
- if (err)
- return err;
- /* The high-speed function is busy. Try again */
- if (!(__be32_to_cpu(switch_status[7]) & SD_HIGHSPEED_BUSY))
- break;
- }
- /* If high-speed isn't supported, we return */
- if (__be32_to_cpu(switch_status[3]) & SD_HIGHSPEED_SUPPORTED)
- mmc->card_caps |= MMC_CAP(SD_HS);
- return 0;
- }
- static int sd_set_card_speed(struct mmc *mmc, enum bus_mode mode)
- {
- int err;
- ALLOC_CACHE_ALIGN_BUFFER(u32, switch_status, 16);
- int speed;
- switch (mode) {
- case SD_LEGACY:
- speed = UHS_SDR12_BUS_SPEED;
- break;
- case SD_HS:
- speed = HIGH_SPEED_BUS_SPEED;
- break;
- default:
- return -EINVAL;
- }
- err = sd_switch(mmc, SD_SWITCH_SWITCH, 0, speed, (u8 *)switch_status);
- if (err)
- return err;
- if (((__be32_to_cpu(switch_status[4]) >> 24) & 0xF) != speed)
- return -ENOTSUPP;
- return 0;
- }
- static int sd_select_bus_width(struct mmc *mmc, int w)
- {
- int err;
- struct mmc_cmd cmd;
- if ((w != 4) && (w != 1))
- return -EINVAL;
- cmd.cmdidx = MMC_CMD_APP_CMD;
- cmd.resp_type = MMC_RSP_R1;
- cmd.cmdarg = mmc->rca << 16;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- cmd.cmdidx = SD_CMD_APP_SET_BUS_WIDTH;
- cmd.resp_type = MMC_RSP_R1;
- if (w == 4)
- cmd.cmdarg = 2;
- else if (w == 1)
- cmd.cmdarg = 0;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- return 0;
- }
- static int sd_read_ssr(struct mmc *mmc)
- {
- static const unsigned int sd_au_size[] = {
- 0, SZ_16K / 512, SZ_32K / 512,
- SZ_64K / 512, SZ_128K / 512, SZ_256K / 512,
- SZ_512K / 512, SZ_1M / 512, SZ_2M / 512,
- SZ_4M / 512, SZ_8M / 512, (SZ_8M + SZ_4M) / 512,
- SZ_16M / 512, (SZ_16M + SZ_8M) / 512, SZ_32M / 512,
- SZ_64M / 512,
- };
- int err, i;
- struct mmc_cmd cmd;
- ALLOC_CACHE_ALIGN_BUFFER(u32, ssr, 16);
- struct mmc_data data;
- int timeout = 3;
- unsigned int au, eo, et, es;
- cmd.cmdidx = MMC_CMD_APP_CMD;
- cmd.resp_type = MMC_RSP_R1;
- cmd.cmdarg = mmc->rca << 16;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- cmd.cmdidx = SD_CMD_APP_SD_STATUS;
- cmd.resp_type = MMC_RSP_R1;
- cmd.cmdarg = 0;
- retry_ssr:
- data.dest = (char *)ssr;
- data.blocksize = 64;
- data.blocks = 1;
- data.flags = MMC_DATA_READ;
- err = mmc_send_cmd(mmc, &cmd, &data);
- if (err) {
- if (timeout--)
- goto retry_ssr;
- return err;
- }
- for (i = 0; i < 16; i++)
- ssr[i] = __be32_to_cpu(ssr[i]);
- au = (ssr[2] >> 12) & 0xF;
- if ((au <= 9) || (mmc->version == SD_VERSION_3)) {
- mmc->ssr.au = sd_au_size[au];
- es = (ssr[3] >> 24) & 0xFF;
- es |= (ssr[2] & 0xFF) << 8;
- et = (ssr[3] >> 18) & 0x3F;
- if (es && et) {
- eo = (ssr[3] >> 16) & 0x3;
- mmc->ssr.erase_timeout = (et * 1000) / es;
- mmc->ssr.erase_offset = eo * 1000;
- }
- } else {
- printk("Invalid Allocation Unit Size.\n");
- }
- return 0;
- }
- /* frequency bases */
- /* divided by 10 to be nice to platforms without floating point */
- static const int fbase[] = {
- 10000,
- 100000,
- 1000000,
- 10000000,
- };
- /* Multiplier values for TRAN_SPEED. Multiplied by 10 to be nice
- * to platforms without floating point.
- */
- static const int multipliers[] = {
- 0, /* reserved */
- 10,
- 12,
- 13,
- 15,
- 20,
- 25,
- 30,
- 35,
- 40,
- 45,
- 50,
- 55,
- 60,
- 70,
- 80,
- };
- static void mmc_set_ios(struct mmc *mmc)
- {
- if (mmc->cfg->ops->set_ios)
- mmc->cfg->ops->set_ios(mmc);
- }
- void mmc_set_clock(struct mmc *mmc, u32 clock, bool disable)
- {
- if (!disable) {
- if (clock > mmc->cfg->f_max)
- clock = mmc->cfg->f_max;
- if (clock < mmc->cfg->f_min)
- clock = mmc->cfg->f_min;
- }
- mmc->clock = clock;
- mmc->clk_disable = disable;
- // printk("clock is %s (%dHz)\n", disable ? "disabled" : "enabled", clock);
- mmc_set_ios(mmc);
- }
- static void mmc_set_bus_width(struct mmc *mmc, u32 width)
- {
- mmc->bus_width = width;
- mmc_set_ios(mmc);
- }
- struct mode_width_tuning {
- enum bus_mode mode;
- u32 widths;
- };
- static const struct mode_width_tuning sd_modes_by_pref[] = {
- {
- .mode = SD_HS,
- .widths = MMC_MODE_4BIT | MMC_MODE_1BIT,
- },
- {
- .mode = SD_LEGACY,
- .widths = MMC_MODE_4BIT | MMC_MODE_1BIT,
- }
- };
- #define for_each_sd_mode_by_pref(caps, mwt) \
- for (mwt = sd_modes_by_pref;\
- mwt < sd_modes_by_pref + ARRAY_SIZE(sd_modes_by_pref);\
- mwt++) \
- if (caps & MMC_CAP(mwt->mode))
- static int sd_select_mode_and_width(struct mmc *mmc, u32 card_caps)
- {
- int err;
- u32 widths[] = {MMC_MODE_4BIT, MMC_MODE_1BIT};
- const struct mode_width_tuning *mwt;
- bool uhs_en = false;
- u32 caps;
- if (mmc_host_is_spi(mmc))
- {
- mmc_select_mode(mmc, SD_LEGACY);
- mmc_set_clock(mmc, mmc->tran_speed,
- MMC_CLK_ENABLE);
- return 0;
- }
- /* Restrict card's capabilities by what the host can do */
- caps = card_caps & mmc->host_caps;
- if (!uhs_en)
- caps &= ~UHS_CAPS;
- for_each_sd_mode_by_pref(caps, mwt) {
- u32 *w;
- for (w = widths; w < widths + ARRAY_SIZE(widths); w++) {
- if (*w & caps & mwt->widths) {
- // printk("trying mode %s width %d (at %d MHz)\n",
- // mmc_mode_name(mwt->mode),
- // bus_width(*w),
- // mmc_mode2freq(mmc, mwt->mode) / 1000000);
- /* configure the bus width (card + host) */
- err = sd_select_bus_width(mmc, bus_width(*w));
- if (err)
- goto error;
- mmc_set_bus_width(mmc, bus_width(*w));
- /* configure the bus mode (card) */
- err = sd_set_card_speed(mmc, mwt->mode);
- if (err)
- goto error;
- /* configure the bus mode (host) */
- mmc_select_mode(mmc, mwt->mode);
- mmc_set_clock(mmc, mmc->tran_speed,
- MMC_CLK_ENABLE);
- err = sd_read_ssr(mmc);
- if (err)
- printk("unable to read ssr\n");
- if (!err)
- return 0;
- error:
- /* revert to a safer bus speed */
- mmc_select_mode(mmc, SD_LEGACY);
- mmc_set_clock(mmc, mmc->tran_speed,
- MMC_CLK_ENABLE);
- }
- }
- }
- printk("unable to select a mode\n");
- return -ENOTSUPP;
- }
- /*
- * read the compare the part of ext csd that is constant.
- * This can be used to check that the transfer is working
- * as expected.
- */
- static int mmc_read_and_compare_ext_csd(struct mmc *mmc)
- {
- int err;
- const u8 *ext_csd = mmc->ext_csd;
- ALLOC_CACHE_ALIGN_BUFFER(u8, test_csd, MMC_MAX_BLOCK_LEN);
- if (mmc->version < MMC_VERSION_4)
- return 0;
- err = mmc_send_ext_csd(mmc, test_csd);
- if (err)
- return err;
- /* Only compare read only fields */
- if (ext_csd[EXT_CSD_PARTITIONING_SUPPORT]
- == test_csd[EXT_CSD_PARTITIONING_SUPPORT] &&
- ext_csd[EXT_CSD_HC_WP_GRP_SIZE]
- == test_csd[EXT_CSD_HC_WP_GRP_SIZE] &&
- ext_csd[EXT_CSD_REV]
- == test_csd[EXT_CSD_REV] &&
- ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]
- == test_csd[EXT_CSD_HC_ERASE_GRP_SIZE] &&
- sys_memcmp(&ext_csd[EXT_CSD_SEC_CNT],
- &test_csd[EXT_CSD_SEC_CNT], 4) == 0)
- return 0;
- return -EBADMSG;
- }
-
- static const struct mode_width_tuning mmc_modes_by_pref[] = {
- {
- .mode = MMC_DDR_52,
- .widths = MMC_MODE_8BIT | MMC_MODE_4BIT,
- },
- {
- .mode = MMC_HS_52,
- .widths = MMC_MODE_8BIT | MMC_MODE_4BIT | MMC_MODE_1BIT,
- },
- {
- .mode = MMC_HS,
- .widths = MMC_MODE_8BIT | MMC_MODE_4BIT | MMC_MODE_1BIT,
- },
- {
- .mode = MMC_LEGACY,
- .widths = MMC_MODE_8BIT | MMC_MODE_4BIT | MMC_MODE_1BIT,
- }
- };
- #define for_each_mmc_mode_by_pref(caps, mwt) \
- for (mwt = mmc_modes_by_pref;\
- mwt < mmc_modes_by_pref + ARRAY_SIZE(mmc_modes_by_pref);\
- mwt++) \
- if (caps & MMC_CAP(mwt->mode))
-
- static const struct ext_csd_bus_width {
- u32 cap;
- bool is_ddr;
- u32 ext_csd_bits;
- } ext_csd_bus_width[] = {
- {MMC_MODE_8BIT, true, EXT_CSD_DDR_BUS_WIDTH_8},
- {MMC_MODE_4BIT, true, EXT_CSD_DDR_BUS_WIDTH_4},
- {MMC_MODE_8BIT, false, EXT_CSD_BUS_WIDTH_8},
- {MMC_MODE_4BIT, false, EXT_CSD_BUS_WIDTH_4},
- {MMC_MODE_1BIT, false, EXT_CSD_BUS_WIDTH_1},
- };
- #define for_each_supported_width(caps, ddr, ecbv) \
- for (ecbv = ext_csd_bus_width;\
- ecbv < ext_csd_bus_width + ARRAY_SIZE(ext_csd_bus_width);\
- ecbv++) \
- if ((ddr == ecbv->is_ddr) && (caps & ecbv->cap))
- static int mmc_select_mode_and_width(struct mmc *mmc, u32 card_caps)
- {
- int err;
- const struct mode_width_tuning *mwt;
- const struct ext_csd_bus_width *ecbw;
- /* Restrict card's capabilities by what the host can do */
- card_caps &= mmc->host_caps;
- /* Only version 4 of MMC supports wider bus widths */
- if (mmc->version < MMC_VERSION_4)
- return 0;
- if (!mmc->ext_csd) {
- printk("No ext_csd found!\n"); /* this should enver happen */
- return -ENOTSUPP;
- }
- mmc_set_clock(mmc, mmc->legacy_speed, MMC_CLK_ENABLE);
- for_each_mmc_mode_by_pref(card_caps, mwt) {
- for_each_supported_width(card_caps & mwt->widths,
- mmc_is_mode_ddr(mwt->mode), ecbw) {
-
- // printk("trying mode %s width %d (at %d MHz)\n",
- // mmc_mode_name(mwt->mode),
- // bus_width(ecbw->cap),
- // mmc_mode2freq(mmc, mwt->mode) / 1000000);
- /* configure the bus width (card + host) */
- err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
- EXT_CSD_BUS_WIDTH,
- ecbw->ext_csd_bits & ~EXT_CSD_DDR_FLAG);
- if (err)
- goto error;
- mmc_set_bus_width(mmc, bus_width(ecbw->cap));
- /* configure the bus speed (card) */
- err = mmc_set_card_speed(mmc, mwt->mode);
- if (err)
- goto error;
- /*
- * configure the bus width AND the ddr mode (card)
- * The host side will be taken care of in the next step
- */
- if (ecbw->ext_csd_bits & EXT_CSD_DDR_FLAG) {
- err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
- EXT_CSD_BUS_WIDTH,
- ecbw->ext_csd_bits);
- if (err)
- goto error;
- }
- /* configure the bus mode (host) */
- mmc_select_mode(mmc, mwt->mode);
- mmc_set_clock(mmc, mmc->tran_speed, MMC_CLK_ENABLE);
- /* do a transfer to check the configuration */
- err = mmc_read_and_compare_ext_csd(mmc);
- if (!err)
- return 0;
- error:
- /* if an error occured, revert to a safer bus mode */
- mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
- EXT_CSD_BUS_WIDTH, EXT_CSD_BUS_WIDTH_1);
- mmc_select_mode(mmc, MMC_LEGACY);
- mmc_set_bus_width(mmc, 1);
- }
- }
- printk("unable to select a mode\n");
- return -ENOTSUPP;
- }
- static int mmc_startup_v4(struct mmc *mmc)
- {
- int err, i;
- u64 capacity;
- bool has_parts = false;
- bool part_completed;
- static const u32 mmc_versions[] = {
- MMC_VERSION_4,
- MMC_VERSION_4_1,
- MMC_VERSION_4_2,
- MMC_VERSION_4_3,
- MMC_VERSION_4_4,
- MMC_VERSION_4_41,
- MMC_VERSION_4_5,
- MMC_VERSION_5_0,
- MMC_VERSION_5_1
- };
- ALLOC_CACHE_ALIGN_BUFFER(u8, ext_csd, MMC_MAX_BLOCK_LEN);
- if (IS_SD(mmc) || (mmc->version < MMC_VERSION_4))
- return 0;
- /* check ext_csd version and capacity */
- err = mmc_send_ext_csd(mmc, ext_csd);
- if (err)
- goto error;
- /* store the ext csd for future reference */
- sys_memcpy(mmc->ext_csd, ext_csd, MMC_MAX_BLOCK_LEN);
- if (ext_csd[EXT_CSD_REV] >= ARRAY_SIZE(mmc_versions))
- return -EINVAL;
- mmc->version = mmc_versions[ext_csd[EXT_CSD_REV]];
- if (mmc->version >= MMC_VERSION_4_2) {
- /*
- * According to the JEDEC Standard, the value of
- * ext_csd's capacity is valid if the value is more
- * than 2GB
- */
- capacity = ext_csd[EXT_CSD_SEC_CNT] << 0
- | ext_csd[EXT_CSD_SEC_CNT + 1] << 8
- | ext_csd[EXT_CSD_SEC_CNT + 2] << 16
- | ext_csd[EXT_CSD_SEC_CNT + 3] << 24;
- capacity *= MMC_MAX_BLOCK_LEN;
- if ((capacity >> 20) > 2 * 1024)
- mmc->capacity_user = capacity;
- }
- /* The partition data may be non-zero but it is only
- * effective if PARTITION_SETTING_COMPLETED is set in
- * EXT_CSD, so ignore any data if this bit is not set,
- * except for enabling the high-capacity group size
- * definition (see below).
- */
- part_completed = !!(ext_csd[EXT_CSD_PARTITION_SETTING] &
- EXT_CSD_PARTITION_SETTING_COMPLETED);
- /* store the partition info of emmc */
- mmc->part_support = ext_csd[EXT_CSD_PARTITIONING_SUPPORT];
- if ((ext_csd[EXT_CSD_PARTITIONING_SUPPORT] & PART_SUPPORT) ||
- ext_csd[EXT_CSD_BOOT_MULT])
- mmc->part_config = ext_csd[EXT_CSD_PART_CONF];
- if (part_completed &&
- (ext_csd[EXT_CSD_PARTITIONING_SUPPORT] & ENHNCD_SUPPORT))
- mmc->part_attr = ext_csd[EXT_CSD_PARTITIONS_ATTRIBUTE];
- mmc->capacity_boot = ext_csd[EXT_CSD_BOOT_MULT] << 17;
- mmc->capacity_rpmb = ext_csd[EXT_CSD_RPMB_MULT] << 17;
- for (i = 0; i < 4; i++) {
- int idx = EXT_CSD_GP_SIZE_MULT + i * 3;
- u32 mult = (ext_csd[idx + 2] << 16) +
- (ext_csd[idx + 1] << 8) + ext_csd[idx];
- if (mult)
- has_parts = true;
- if (!part_completed)
- continue;
- mmc->capacity_gp[i] = mult;
- mmc->capacity_gp[i] *=
- ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
- mmc->capacity_gp[i] *= ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
- mmc->capacity_gp[i] <<= 19;
- }
- if (part_completed) {
- mmc->enh_user_size =
- (ext_csd[EXT_CSD_ENH_SIZE_MULT + 2] << 16) +
- (ext_csd[EXT_CSD_ENH_SIZE_MULT + 1] << 8) +
- ext_csd[EXT_CSD_ENH_SIZE_MULT];
- mmc->enh_user_size *= ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
- mmc->enh_user_size *= ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
- mmc->enh_user_size <<= 19;
- mmc->enh_user_start =
- (ext_csd[EXT_CSD_ENH_START_ADDR + 3] << 24) +
- (ext_csd[EXT_CSD_ENH_START_ADDR + 2] << 16) +
- (ext_csd[EXT_CSD_ENH_START_ADDR + 1] << 8) +
- ext_csd[EXT_CSD_ENH_START_ADDR];
- if (mmc->high_capacity)
- mmc->enh_user_start <<= 9;
- }
- /*
- * Host needs to enable ERASE_GRP_DEF bit if device is
- * partitioned. This bit will be lost every time after a reset
- * or power off. This will affect erase size.
- */
- if (part_completed)
- has_parts = true;
- if ((ext_csd[EXT_CSD_PARTITIONING_SUPPORT] & PART_SUPPORT) &&
- (ext_csd[EXT_CSD_PARTITIONS_ATTRIBUTE] & PART_ENH_ATTRIB))
- has_parts = true;
- if (has_parts) {
- err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
- EXT_CSD_ERASE_GROUP_DEF, 1);
- if (err)
- goto error;
- ext_csd[EXT_CSD_ERASE_GROUP_DEF] = 1;
- }
- if (ext_csd[EXT_CSD_ERASE_GROUP_DEF] & 0x01) {
- /* Read out group size from ext_csd */
- mmc->erase_grp_size =
- ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE] * 1024;
- /*
- * if high capacity and partition setting completed
- * SEC_COUNT is valid even if it is smaller than 2 GiB
- * JEDEC Standard JESD84-B45, 6.2.4
- */
- if (mmc->high_capacity && part_completed) {
- capacity = (ext_csd[EXT_CSD_SEC_CNT]) |
- (ext_csd[EXT_CSD_SEC_CNT + 1] << 8) |
- (ext_csd[EXT_CSD_SEC_CNT + 2] << 16) |
- (ext_csd[EXT_CSD_SEC_CNT + 3] << 24);
- capacity *= MMC_MAX_BLOCK_LEN;
- mmc->capacity_user = capacity;
- }
- }
- else {
- /* Calculate the group size from the csd value. */
- int erase_gsz, erase_gmul;
- erase_gsz = (mmc->csd[2] & 0x00007c00) >> 10;
- erase_gmul = (mmc->csd[2] & 0x000003e0) >> 5;
- mmc->erase_grp_size = (erase_gsz + 1)
- * (erase_gmul + 1);
- }
- mmc->hc_wp_grp_size = 1024
- * ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]
- * ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
- mmc->wr_rel_set = ext_csd[EXT_CSD_WR_REL_SET];
- return 0;
- error:
- if (mmc->ext_csd) {
- mmc->ext_csd = NULL;
- }
- return err;
- }
- static int mmc_startup(struct mmc *mmc)
- {
- int err, i;
- u32 mult, freq;
- UINT64 cmult, csize;
- struct mmc_cmd cmd;
- ALLOC_CACHE_ALIGN_BUFFER(u8, ext_csd, MMC_MAX_BLOCK_LEN);
- ALLOC_CACHE_ALIGN_BUFFER(u8, test_csd, MMC_MAX_BLOCK_LEN);
- int timeout = 1000;
- unsigned int has_parts = 0;
- unsigned int part_completed;
- /* Put the Card in Identify Mode */
- cmd.cmdidx = mmc_host_is_spi(mmc) ? MMC_CMD_SEND_CID :
- MMC_CMD_ALL_SEND_CID; /* cmd not supported in spi */
- cmd.resp_type = MMC_RSP_R2;
- cmd.cmdarg = 0;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- sys_memcpy(mmc->cid, cmd.response, 16);
- /*
- * For MMC cards, set the Relative Address.
- * For SD cards, get the Relatvie Address.
- * This also printf the cards into Standby State
- */
- if (!mmc_host_is_spi(mmc)) { /* cmd not supported in spi */
- cmd.cmdidx = SD_CMD_SEND_RELATIVE_ADDR;
- cmd.cmdarg = mmc->rca << 16;
- cmd.resp_type = MMC_RSP_R6;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- if (IS_SD(mmc))
- mmc->rca = (cmd.response[0] >> 16) & 0xffff;
- }
- /* Get the Card-Specific Data */
- cmd.cmdidx = MMC_CMD_SEND_CSD;
- cmd.resp_type = MMC_RSP_R2;
- cmd.cmdarg = mmc->rca << 16;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- mmc->csd[0] = cmd.response[0];
- mmc->csd[1] = cmd.response[1];
- mmc->csd[2] = cmd.response[2];
- mmc->csd[3] = cmd.response[3];
- if (mmc->version == MMC_VERSION_UNKNOWN) {
- int version = (cmd.response[0] >> 26) & 0xf;
- switch (version) {
- case 0:
- mmc->version = MMC_VERSION_1_2;
- break;
- case 1:
- mmc->version = MMC_VERSION_1_4;
- break;
- case 2:
- mmc->version = MMC_VERSION_2_2;
- break;
- case 3:
- mmc->version = MMC_VERSION_3;
- break;
- case 4:
- mmc->version = MMC_VERSION_4;
- break;
- default:
- mmc->version = MMC_VERSION_1_2;
- break;
- }
- }
- /* divide frequency by 10, since the mults are 10x bigger */
- freq = fbase[(cmd.response[0] & 0x7)];
- mult = multipliers[((cmd.response[0] >> 3) & 0xf)];
- mmc->legacy_speed = freq * mult;
- mmc_select_mode(mmc, MMC_LEGACY);
- mmc->dsr_imp = ((cmd.response[1] >> 12) & 0x1);
- mmc->read_bl_len = 1 << ((cmd.response[1] >> 16) & 0xf);
- if (IS_SD(mmc))
- mmc->write_bl_len = mmc->read_bl_len;
- else
- mmc->write_bl_len = 1 << ((cmd.response[3] >> 22) & 0xf);
- if (mmc->high_capacity) {
- csize = (mmc->csd[1] & 0x3f) << 16
- | (mmc->csd[2] & 0xffff0000) >> 16;
- cmult = 8;
- } else {
- csize = (mmc->csd[1] & 0x3ff) << 2
- | (mmc->csd[2] & 0xc0000000) >> 30;
- cmult = (mmc->csd[2] & 0x00038000) >> 15;
- }
- mmc->capacity_user = (csize + 1) << (cmult + 2);
- mmc->capacity_user *= mmc->read_bl_len;
- //printf("mmc->capacity_user = %d\r\n", mmc->capacity_user);
- mmc->capacity_boot = 0;
- mmc->capacity_rpmb = 0;
- for (i = 0; i < 4; i++)
- mmc->capacity_gp[i] = 0;
- if (mmc->read_bl_len > MMC_MAX_BLOCK_LEN)
- mmc->read_bl_len = MMC_MAX_BLOCK_LEN;
- if (mmc->write_bl_len > MMC_MAX_BLOCK_LEN)
- mmc->write_bl_len = MMC_MAX_BLOCK_LEN;
- if ((mmc->dsr_imp) && (0xffffffff != mmc->dsr)) {
- cmd.cmdidx = MMC_CMD_SET_DSR;
- cmd.cmdarg = (mmc->dsr & 0xffff) << 16;
- cmd.resp_type = MMC_RSP_NONE;
- if (mmc_send_cmd(mmc, &cmd, NULL))
- rlSendString("MMC: SET_DSR failed\r\n");
- }
- /* Select the card, and put it into Transfer Mode */
- if (!mmc_host_is_spi(mmc)) { /* cmd not supported in spi */
- cmd.cmdidx = MMC_CMD_SELECT_CARD;
- cmd.resp_type = MMC_RSP_R1;
- cmd.cmdarg = mmc->rca << 16;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- }
- /*
- * For SD, its erase group is always one sector
- */
- mmc->erase_grp_size = 1;
- mmc->part_config = MMCPART_NOAVAILABLE;
- err = mmc_startup_v4(mmc);
- if (err)
- return err;
- err = mmc_set_capacity(mmc, mmc->block_dev.hwpart);
- if (err)
- return err;
- if (IS_SD(mmc)) {
- err = sd_get_capabilities(mmc);
- if (err)
- return err;
- err = sd_select_mode_and_width(mmc, mmc->card_caps);
- } else {
- err = mmc_get_capabilities(mmc);
- if (err)
- return err;
- mmc_select_mode_and_width(mmc, mmc->card_caps);
- }
- if (err)
- return err;
- mmc->best_mode = mmc->selected_mode;
-
- /* Fix the block length for DDR mode */
- if (mmc->ddr_mode) {
- mmc->read_bl_len = MMC_MAX_BLOCK_LEN;
- mmc->write_bl_len = MMC_MAX_BLOCK_LEN;
- }
- /* fill in device description */
- mmc->block_dev.lun = 0;
- mmc->block_dev.hwpart = 0;
- mmc->block_dev.type = 0;
- mmc->block_dev.blksz = mmc->read_bl_len;
- mmc->block_dev.log2blksz = LOG2(mmc->block_dev.blksz);
- mmc->block_dev.lba = lldiv(mmc->capacity, mmc->read_bl_len);
- mmc->block_dev.vendor[0] = 0;
- mmc->block_dev.product[0] = 0;
- mmc->block_dev.revision[0] = 0;
- return 0;
- }
- static int mmc_send_if_cond(struct mmc *mmc)
- {
- struct mmc_cmd cmd;
- int err;
- cmd.cmdidx = SD_CMD_SEND_IF_COND;
- /* We set the bit if the host supports voltages between 2.7 and 3.6 V */
- cmd.cmdarg = ((mmc->cfg->voltages & 0xff8000) != 0) << 8 | 0xaa;
- cmd.resp_type = MMC_RSP_R7;
- err = mmc_send_cmd(mmc, &cmd, NULL);
- if (err)
- return err;
- if ((cmd.response[0] & 0xff) != 0xaa)
- return -EOPNOTSUPP;
- else
- mmc->version = SD_VERSION_2;
- return 0;
- }
- struct mmc *mmc_create(const struct mmc_config *cfg, void *priv, u32 dev_num)
- {
- struct mmc *mmc;
-
- if(dev_num != 0)
- return NULL;
-
- mmc = &local_mmc0;
- /* quick validation */
- if (cfg == NULL || cfg->ops == NULL || cfg->ops->send_cmd == NULL ||
- cfg->f_min == 0 || cfg->f_max == 0 || cfg->b_max == 0)
- return NULL;
- mmc->cfg = cfg;
- mmc->priv = priv;
- /* the following chunk was mmc_register() */
- /* Setup dsr related values */
- mmc->dsr_imp = 0;
- mmc->dsr = 0xffffffff;
- /* Setup the universal parts of the block interface just once */
- mmc->block_dev.if_type = IF_TYPE_MMC;
- mmc->block_dev.dev = cur_dev_num++;
- mmc->block_dev.removable = 1;
- mmc->block_dev.block_read = mmc_bread;
- mmc->block_dev.block_write = mmc_bwrite;
- mmc->block_dev.block_erase = mmc_berase;
- /* setup initial part type */
- mmc->block_dev.part_type = mmc->cfg->part_type;
- return mmc;
- }
- static int mmc_power_init(struct mmc *mmc)
- {
- return 0;
- }
- /*
- * put the host in the initial state:
- * - turn on Vdd (card power supply)
- * - configure the bus width and clock to minimal values
- */
- static void mmc_set_initial_state(struct mmc *mmc)
- {
- mmc_select_mode(mmc, MMC_LEGACY);
- mmc_set_bus_width(mmc, 1);
- mmc_set_clock(mmc, 0, MMC_CLK_ENABLE);
- }
- static int mmc_power_on(struct mmc *mmc)
- {
- return 0;
- }
- static int mmc_power_off(struct mmc *mmc)
- {
- mmc_set_clock(mmc, 0, MMC_CLK_DISABLE);
- return 0;
- }
- static int mmc_power_cycle(struct mmc *mmc)
- {
- int ret;
- ret = mmc_power_off(mmc);
- if (ret)
- return ret;
- /*
- * SD spec recommends at least 1ms of delay. Let's wait for 2ms
- * to be on the safer side.
- */
- udelay(2000);
- return mmc_power_on(mmc);
- }
- int mmc_get_op_cond(struct mmc *mmc)
- {
- bool uhs_en = supports_uhs(mmc->cfg->host_caps);
- int err;
- if (mmc->has_init)
- return 0;
- err = mmc_power_init(mmc);
- if (err)
- return err;
- err = mmc_power_cycle(mmc);
- if (err) {
- /*
- * if power cycling is not supported, we should not try
- * to use the UHS modes, because we wouldn't be able to
- * recover from an error during the UHS initialization.
- */
- printk("Unable to do a full power cycle. Disabling the UHS modes for safety\n");
- uhs_en = false;
- mmc->host_caps &= ~UHS_CAPS;
- err = mmc_power_on(mmc);
- }
- if (err)
- return err;
- /* made sure it's not NULL earlier */
- err = mmc->cfg->ops->init(mmc);
- if (err)
- return err;
- mmc->ddr_mode = 0;
- retry:
- mmc_set_initial_state(mmc);
- /* Reset the Card */
- err = mmc_go_idle(mmc);
- if (err)
- return err;
- /* The internal partition reset to user partition(0) at every CMD0*/
- mmc->block_dev.hwpart = 0;
-
- /* Test for SD version 2 */
- err = mmc_send_if_cond(mmc);
- /* Now try to get the SD card's operating condition */
- err = sd_send_op_cond(mmc, uhs_en);
- if (err && uhs_en) {
- uhs_en = false;
- mmc_power_cycle(mmc);
- goto retry;
- }
- /* If the command timed out, we check for an MMC card */
- if (err == -ETIMEDOUT) {
- err = mmc_send_op_cond(mmc);
- if (err) {
- printk("Card did not respond to voltage select!\n");
- return -EOPNOTSUPP;
- }
- }
- return err;
- }
- int mmc_start_init(struct mmc *mmc)
- {
- int err = 0;
- /*
- * all hosts are capable of 1 bit bus-width and able to use the legacy
- * timings.
- */
- mmc->host_caps = mmc->cfg->host_caps | MMC_CAP(SD_LEGACY) |
- MMC_CAP(MMC_LEGACY) | MMC_MODE_1BIT;
- err = mmc_get_op_cond(mmc);
- if (!err)
- mmc->init_in_progress = 1;
- return err;
- }
- #if 0
- static void print_mmcinfo(struct mmc *mmc)
- {
- int i;
- printk("Device: %s\r\n", mmc->cfg->name);
- printk("Manufacturer ID: %x\r\n", mmc->cid[0] >> 24);
- printk("OEM: %x\r\n", (mmc->cid[0] >> 8) & 0xffff);
- printk("Name: %c%c%c%c%c \r\n", mmc->cid[0] & 0xff,
- (mmc->cid[1] >> 24), (mmc->cid[1] >> 16) & 0xff,
- (mmc->cid[1] >> 8) & 0xff, mmc->cid[1] & 0xff);
- printk("Tran Speed: %d\r\n", mmc->tran_speed);
- printk("Rd Block Len: %d\r\n", mmc->read_bl_len);
- printk("%s version %d.%d", IS_SD(mmc) ? "SD" : "MMC",
- EXTRACT_SDMMC_MAJOR_VERSION(mmc->version),
- EXTRACT_SDMMC_MINOR_VERSION(mmc->version));
- if (EXTRACT_SDMMC_CHANGE_VERSION(mmc->version) != 0)
- printk(".%d", EXTRACT_SDMMC_CHANGE_VERSION(mmc->version));
- printk("\r\n");
- printk("High Capacity: %s\r\n", mmc->high_capacity ? "Yes" : "No");
- printk("Capacity: ");
- print_size(mmc->capacity, "\r\n");
- printk("Bus Width: %d-bit%s\r\n", mmc->bus_width,
- mmc->ddr_mode ? " DDR" : "");
- printk("Erase Group Size: 0x%x\r\n", ((u64)mmc->erase_grp_size) << 9);
- //printf(((u64)mmc->erase_grp_size) << 9, "\r\n");
- if (!IS_SD(mmc) && mmc->version >= MMC_VERSION_4_41) {
- int has_enh = (mmc->part_support & ENHNCD_SUPPORT) != 0;
- int usr_enh = has_enh && (mmc->part_attr & EXT_CSD_ENH_USR);
- printk("HC WP Group Size: ");
- printk(((u64)mmc->hc_wp_grp_size) << 9, "\n");
- printk("User Capacity: ");
- printk(mmc->capacity_user, usr_enh ? " ENH" : "");
- if (mmc->wr_rel_set & EXT_CSD_WR_DATA_REL_USR)
- printk(" WRREL\n");
- else
- printk('\n');
- if (usr_enh) {
- printk("User Enhanced Start: ");
- printk(mmc->enh_user_start, "\r\n");
- printk("User Enhanced Size: ");
- printk(mmc->enh_user_size, "\r\n");
- }
- printk("Boot Capacity: ");
- printk(mmc->capacity_boot, has_enh ? " ENH\r\n" : "\r\n");
- printk("RPMB Capacity: ");
- printk(mmc->capacity_rpmb, has_enh ? " ENH\r\n" : "\r\n");
- for (i = 0; i < ARRAY_SIZE(mmc->capacity_gp); i++) {
- int is_enh = has_enh &&
- (mmc->part_attr & EXT_CSD_ENH_GP(i));
- if (mmc->capacity_gp[i]) {
- printk("GP%i Capacity: ", i+1);
- printk(mmc->capacity_gp[i],
- is_enh ? " ENH" : "");
- if (mmc->wr_rel_set & EXT_CSD_WR_DATA_REL_GP(i))
- printk(" WRREL\r\n");
- else
- printk("\r\n");
- }
- }
- }
- }
- #endif
- static int mmc_complete_init(struct mmc *mmc)
- {
- int err = 0;
- mmc->init_in_progress = 0;
- if (mmc->op_cond_pending)
- err = mmc_complete_op_cond(mmc);
- if (!err)
- err = mmc_startup(mmc);
- if (err)
- mmc->has_init = 0;
- else
- mmc->has_init = 1;
- // print_mmcinfo(mmc);
- return err;
- }
- int mmc_init(struct mmc *mmc)
- {
- int err = 0;
- if (mmc->has_init)
- return 0;
- //start = get_timer(0);
- if (!mmc->init_in_progress)
- err = mmc_start_init(mmc);
-
- if (!err)
- err = mmc_complete_init(mmc);
- return err;
- }
- int mmc_set_dsr(struct mmc *mmc, u16 val)
- {
- mmc->dsr = val;
- return 0;
- }
|