1// SPDX-License-Identifier: GPL-2.0+ 2/* 3 * Copyright (c) 2015 Google, Inc 4 * Written by Simon Glass <sjg@chromium.org> 5 */ 6 7#include <dm.h> 8#include <errno.h> 9#include <fdtdec.h> 10#include <log.h> 11#include <malloc.h> 12#include <mmc.h> 13#include <os.h> 14#include <asm/test.h> 15 16struct sandbox_mmc_plat { 17 struct mmc_config cfg; 18 struct mmc mmc; 19 const char *fname; 20}; 21 22#define MMC_CMULT 8 /* 8 because the card is high-capacity */ 23#define MMC_BL_LEN_SHIFT 10 24#define MMC_BL_LEN BIT(MMC_BL_LEN_SHIFT) 25 26/* Granularity of priv->csize - this is 1MB */ 27#define SIZE_MULTIPLE ((1 << (MMC_CMULT + 2)) * MMC_BL_LEN) 28 29struct sandbox_mmc_priv { 30 char *buf; 31 int csize; /* CSIZE value to report */ 32 int size; 33}; 34 35/** 36 * sandbox_mmc_send_cmd() - Emulate SD commands 37 * 38 * This emulate an SD card version 2. Single-block reads result in zero data. 39 * Multiple-block reads return a test string. 40 */ 41static int sandbox_mmc_send_cmd(struct udevice *dev, struct mmc_cmd *cmd, 42 struct mmc_data *data) 43{ 44 struct sandbox_mmc_priv *priv = dev_get_priv(dev); 45 static ulong erase_start, erase_end; 46 47 switch (cmd->cmdidx) { 48 case MMC_CMD_ALL_SEND_CID: 49 memset(cmd->response, '\0', sizeof(cmd->response)); 50 break; 51 case SD_CMD_SEND_RELATIVE_ADDR: 52 cmd->response[0] = 0 << 16; /* mmc->rca */ 53 case MMC_CMD_GO_IDLE_STATE: 54 break; 55 case SD_CMD_SEND_IF_COND: 56 cmd->response[0] = 0xaa; 57 break; 58 case MMC_CMD_SEND_STATUS: 59 cmd->response[0] = MMC_STATUS_RDY_FOR_DATA; 60 break; 61 case MMC_CMD_SELECT_CARD: 62 break; 63 case MMC_CMD_SEND_CSD: 64 cmd->response[0] = 0; 65 cmd->response[1] = (MMC_BL_LEN_SHIFT << 16) | 66 ((priv->csize >> 16) & 0x3f); 67 cmd->response[2] = (priv->csize & 0xffff) << 16; 68 cmd->response[3] = 0; 69 break; 70 case SD_CMD_SWITCH_FUNC: { 71 if (!data) 72 break; 73 u32 *resp = (u32 *)data->dest; 74 resp[3] = 0; 75 resp[7] = cpu_to_be32(SD_HIGHSPEED_BUSY); 76 if ((cmd->cmdarg & 0xF) == UHS_SDR12_BUS_SPEED) 77 resp[4] = (cmd->cmdarg & 0xF) << 24; 78 break; 79 } 80 case MMC_CMD_READ_SINGLE_BLOCK: 81 case MMC_CMD_READ_MULTIPLE_BLOCK: 82 memcpy(data->dest, &priv->buf[cmd->cmdarg * data->blocksize], 83 data->blocks * data->blocksize); 84 break; 85 case MMC_CMD_WRITE_SINGLE_BLOCK: 86 case MMC_CMD_WRITE_MULTIPLE_BLOCK: 87 memcpy(&priv->buf[cmd->cmdarg * data->blocksize], data->src, 88 data->blocks * data->blocksize); 89 break; 90 case MMC_CMD_STOP_TRANSMISSION: 91 break; 92 case SD_CMD_ERASE_WR_BLK_START: 93 erase_start = cmd->cmdarg; 94 break; 95 case SD_CMD_ERASE_WR_BLK_END: 96 erase_end = cmd->cmdarg; 97 break; 98#if CONFIG_IS_ENABLED(MMC_WRITE) 99 case MMC_CMD_ERASE: { 100 struct mmc *mmc = mmc_get_mmc_dev(dev); 101 102 memset(&priv->buf[erase_start * mmc->write_bl_len], '\0', 103 (erase_end - erase_start + 1) * mmc->write_bl_len); 104 break; 105 } 106#endif 107 case SD_CMD_APP_SEND_OP_COND: 108 cmd->response[0] = OCR_BUSY | OCR_HCS; 109 cmd->response[1] = 0; 110 cmd->response[2] = 0; 111 break; 112 case MMC_CMD_APP_CMD: 113 break; 114 case MMC_CMD_SET_BLOCKLEN: 115 debug("block len %d\n", cmd->cmdarg); 116 break; 117 case SD_CMD_APP_SEND_SCR: { 118 u32 *scr = (u32 *)data->dest; 119 120 scr[0] = cpu_to_be32(2 << 24 | 1 << 15); /* SD version 3 */ 121 break; 122 } 123 default: 124 debug("%s: Unknown command %d\n", __func__, cmd->cmdidx); 125 break; 126 } 127 128 return 0; 129} 130 131static int sandbox_mmc_set_ios(struct udevice *dev) 132{ 133 return 0; 134} 135 136static int sandbox_mmc_get_cd(struct udevice *dev) 137{ 138 return 1; 139} 140 141static const struct dm_mmc_ops sandbox_mmc_ops = { 142 .send_cmd = sandbox_mmc_send_cmd, 143 .set_ios = sandbox_mmc_set_ios, 144 .get_cd = sandbox_mmc_get_cd, 145}; 146 147static int sandbox_mmc_of_to_plat(struct udevice *dev) 148{ 149 struct sandbox_mmc_plat *plat = dev_get_plat(dev); 150 struct mmc_config *cfg = &plat->cfg; 151 struct blk_desc *blk; 152 int ret; 153 154 plat->fname = dev_read_string(dev, "filename"); 155 156 ret = mmc_of_parse(dev, cfg); 157 if (ret) 158 return ret; 159 blk = mmc_get_blk_desc(&plat->mmc); 160 if (blk) 161 blk->removable = !(cfg->host_caps & MMC_CAP_NONREMOVABLE); 162 163 return 0; 164} 165 166static int sandbox_mmc_probe(struct udevice *dev) 167{ 168 struct sandbox_mmc_plat *plat = dev_get_plat(dev); 169 struct sandbox_mmc_priv *priv = dev_get_priv(dev); 170 int ret; 171 172 if (plat->fname) { 173 ret = os_map_file(plat->fname, OS_O_RDWR | OS_O_CREAT, 174 (void **)&priv->buf, &priv->size); 175 if (ret) { 176 log_err("%s: Unable to map file '%s'\n", dev->name, 177 plat->fname); 178 return ret; 179 } 180 priv->csize = priv->size / SIZE_MULTIPLE - 1; 181 } else { 182 priv->csize = 0; 183 priv->size = (priv->csize + 1) * SIZE_MULTIPLE; /* 1 MiB */ 184 185 priv->buf = calloc(1, priv->size); 186 if (!priv->buf) { 187 log_err("%s: Not enough memory (%x bytes)\n", 188 dev->name, priv->size); 189 return -ENOMEM; 190 } 191 } 192 193 return mmc_init(&plat->mmc); 194} 195 196static int sandbox_mmc_remove(struct udevice *dev) 197{ 198 struct sandbox_mmc_plat *plat = dev_get_plat(dev); 199 struct sandbox_mmc_priv *priv = dev_get_priv(dev); 200 201 if (plat->fname) 202 os_unmap(priv->buf, priv->size); 203 else 204 free(priv->buf); 205 206 return 0; 207} 208 209static int sandbox_mmc_bind(struct udevice *dev) 210{ 211 struct sandbox_mmc_plat *plat = dev_get_plat(dev); 212 struct mmc_config *cfg = &plat->cfg; 213 214 cfg->name = dev->name; 215 cfg->host_caps = MMC_MODE_HS_52MHz | MMC_MODE_HS | MMC_MODE_8BIT; 216 cfg->voltages = MMC_VDD_165_195 | MMC_VDD_32_33 | MMC_VDD_33_34; 217 cfg->f_min = 1000000; 218 cfg->f_max = 52000000; 219 cfg->b_max = U32_MAX; 220 221 return mmc_bind(dev, &plat->mmc, cfg); 222} 223 224static int sandbox_mmc_unbind(struct udevice *dev) 225{ 226 mmc_unbind(dev); 227 228 return 0; 229} 230 231static const struct udevice_id sandbox_mmc_ids[] = { 232 { .compatible = "sandbox,mmc" }, 233 { } 234}; 235 236U_BOOT_DRIVER(mmc_sandbox) = { 237 .name = "mmc_sandbox", 238 .id = UCLASS_MMC, 239 .of_match = sandbox_mmc_ids, 240 .ops = &sandbox_mmc_ops, 241 .bind = sandbox_mmc_bind, 242 .unbind = sandbox_mmc_unbind, 243 .of_to_plat = sandbox_mmc_of_to_plat, 244 .probe = sandbox_mmc_probe, 245 .remove = sandbox_mmc_remove, 246 .priv_auto = sizeof(struct sandbox_mmc_priv), 247 .plat_auto = sizeof(struct sandbox_mmc_plat), 248}; 249