| // SPDX-License-Identifier: GPL-2.0+ |
| /* |
| * Copyright 2008, Freescale Semiconductor, Inc |
| * Andy Fleming |
| * |
| * Based vaguely on the Linux code |
| */ |
| |
| #include <config.h> |
| #include <common.h> |
| #include <dm.h> |
| #include <part.h> |
| #include <div64.h> |
| #include <linux/math64.h> |
| #include "mmc_private.h" |
| |
| |
| extern bool emmckey_is_access_range_legal(struct mmc *mmc, |
| ulong start, lbaint_t blkcnt); |
| |
| static ulong mmc_erase_t(struct mmc *mmc, ulong start, lbaint_t blkcnt) |
| { |
| struct mmc_cmd cmd; |
| ulong end; |
| int err, start_cmd, end_cmd; |
| |
| if (mmc->high_capacity) { |
| end = start + blkcnt - 1; |
| } else { |
| end = (start + blkcnt - 1) * mmc->write_bl_len; |
| start *= mmc->write_bl_len; |
| } |
| |
| if (IS_SD(mmc)) { |
| start_cmd = SD_CMD_ERASE_WR_BLK_START; |
| end_cmd = SD_CMD_ERASE_WR_BLK_END; |
| } else { |
| start_cmd = MMC_CMD_ERASE_GROUP_START; |
| end_cmd = MMC_CMD_ERASE_GROUP_END; |
| } |
| cmd.cmdidx = start_cmd; |
| cmd.cmdarg = start; |
| cmd.resp_type = MMC_RSP_R1; |
| |
| err = mmc_send_cmd(mmc, &cmd, NULL); |
| if (err) |
| goto err_out; |
| |
| cmd.cmdidx = end_cmd; |
| cmd.cmdarg = end; |
| err = mmc_send_cmd(mmc, &cmd, NULL); |
| if (err) |
| goto err_out; |
| |
| cmd.cmdidx = MMC_CMD_ERASE; |
| cmd.cmdarg = MMC_ERASE_ARG; |
| cmd.resp_type = MMC_RSP_R1b; |
| |
| err = mmc_send_cmd(mmc, &cmd, NULL); |
| if (err) |
| goto err_out; |
| |
| return 0; |
| |
| err_out: |
| puts("mmc erase failed\n"); |
| return err; |
| } |
| |
| #ifdef CONFIG_BLK |
| ulong mmc_berase(struct udevice *dev, lbaint_t start, lbaint_t blkcnt) |
| #else |
| ulong mmc_berase(struct blk_desc *block_dev, lbaint_t start, lbaint_t blkcnt) |
| #endif |
| { |
| #ifdef CONFIG_BLK |
| struct blk_desc *block_dev = dev_get_uclass_platdata(dev); |
| #endif |
| int dev_num = block_dev->devnum; |
| int err = 0; |
| u32 start_rem, blkcnt_rem; |
| struct mmc *mmc = find_mmc_device(dev_num); |
| lbaint_t blk = 0, blk_r = 0; |
| int timeout = 1000; |
| |
| if (!mmc) |
| return -1; |
| |
| if (!emmckey_is_access_range_legal(mmc, start, blkcnt)) |
| return blkcnt; |
| |
| err = blk_select_hwpart_devnum(IF_TYPE_MMC, dev_num, |
| block_dev->hwpart); |
| if (err < 0) |
| return -1; |
| if (blkcnt == 0) { |
| blkcnt = mmc->capacity/512 - (mmc->capacity/512)% mmc->erase_grp_size; // erase whole |
| printf("blkcnt = %lu\n",blkcnt); |
| } |
| /* |
| * We want to see if the requested start or total block count are |
| * unaligned. We discard the whole numbers and only care about the |
| * remainder. |
| */ |
| err = div_u64_rem(start, mmc->erase_grp_size, &start_rem); |
| err = div_u64_rem(blkcnt, mmc->erase_grp_size, &blkcnt_rem); |
| if (start_rem || blkcnt_rem) |
| printf("\n\nCaution! Your devices Erase group is 0x%x\n" |
| "The erase range would be change to " |
| "0x" LBAF "~0x" LBAF "\n\n", |
| mmc->erase_grp_size, start & ~(mmc->erase_grp_size - 1), |
| ((start + blkcnt + mmc->erase_grp_size) |
| & ~(mmc->erase_grp_size - 1)) - 1); |
| |
| while (blk < blkcnt) { |
| if (IS_SD(mmc) && mmc->ssr.au) { |
| blk_r = ((blkcnt - blk) > mmc->ssr.au) ? |
| mmc->ssr.au : (blkcnt - blk); |
| } else { |
| blk_r = ((blkcnt - blk) < mmc->erase_grp_size) ? |
| mmc->erase_grp_size : (blkcnt - blk); |
| } |
| err = mmc_erase_t(mmc, start + blk, blk_r); |
| if (err) |
| return 1; |
| |
| blk += blk_r; |
| |
| /* Waiting for the ready status */ |
| if (mmc_send_status(mmc, timeout)) |
| return 1; |
| } |
| |
| return 0; |
| } |
| |
| static int mmc_set_blockcount(struct mmc *mmc, unsigned int blockcount) |
| { |
| struct mmc_cmd cmd = { 0 }; |
| |
| cmd.cmdidx = MMC_CMD_SET_BLOCK_COUNT; |
| cmd.cmdarg = min(blockcount, (unsigned int)MMC_BLOCK_COUNT_MAX); |
| cmd.cmdarg |= MMC_RELIABLE_WRITE_ARG; |
| cmd.resp_type = MMC_RSP_R1; |
| |
| return mmc_send_cmd(mmc, &cmd, NULL); |
| } |
| |
| static ulong mmc_write_blocks(struct mmc *mmc, lbaint_t start, lbaint_t blkcnt, |
| const void *src) |
| { |
| struct mmc_cmd cmd; |
| struct mmc_data data; |
| int timeout = 1000; |
| if ((start + blkcnt) > mmc_get_blk_desc(mmc)->lba) { |
| printf("MMC: block number 0x" LBAF " exceeds max(0x" LBAF ")\n", |
| start + blkcnt, mmc_get_blk_desc(mmc)->lba); |
| return 0; |
| } |
| |
| if (mmc->ext_csd[EXT_CSD_DATA_SECTOR_SIZE] != |
| EXT_CSD_DATA_SECTOR_SIZE_512) { |
| printf("MMC: mmc is not operating in 512 bytes sector size.\n"); |
| return 0; |
| } |
| |
| if (blkcnt == 0) |
| return 0; |
| |
| // Set block count and activate reliable write. |
| if (mmc_set_blockcount(mmc, blkcnt)) |
| return 0; |
| |
| cmd.cmdidx = MMC_CMD_WRITE_MULTIPLE_BLOCK; |
| if (mmc->high_capacity) |
| cmd.cmdarg = start; |
| else |
| cmd.cmdarg = start * mmc->write_bl_len; |
| |
| cmd.resp_type = MMC_RSP_R1; |
| |
| data.src = src; |
| data.blocks = blkcnt; |
| data.blocksize = mmc->write_bl_len; |
| data.flags = MMC_DATA_WRITE; |
| |
| if (mmc_send_cmd(mmc, &cmd, &data)) { |
| printf("mmc write failed\n"); |
| return 0; |
| } |
| |
| // Pre-defined block count. No need for stop command. |
| |
| /* Waiting for the ready status */ |
| if (mmc_send_status(mmc, timeout)) |
| return 0; |
| |
| return blkcnt; |
| } |
| |
| #ifdef CONFIG_BLK |
| ulong mmc_bwrite(struct udevice *dev, lbaint_t start, lbaint_t blkcnt, |
| const void *src) |
| #else |
| ulong mmc_bwrite(struct blk_desc *block_dev, lbaint_t start, lbaint_t blkcnt, |
| const void *src) |
| #endif |
| { |
| #ifdef CONFIG_BLK |
| struct blk_desc *block_dev = dev_get_uclass_platdata(dev); |
| #endif |
| int dev_num = block_dev->devnum; |
| lbaint_t cur, blocks_todo = blkcnt; |
| int err; |
| |
| struct mmc *mmc = find_mmc_device(dev_num); |
| if (!mmc) |
| return 0; |
| |
| err = blk_select_hwpart_devnum(IF_TYPE_MMC, dev_num, block_dev->hwpart); |
| if (err < 0) |
| return 0; |
| |
| if (mmc_set_blocklen(mmc, mmc->write_bl_len)) |
| return 0; |
| |
| if (!emmckey_is_access_range_legal(mmc, start, blkcnt)) |
| return 0; |
| |
| do { |
| cur = min(blocks_todo, (lbaint_t)mmc->cfg->b_max); |
| // Reliable write requires to set block count, which is only 2 bytes. |
| // Thus limit the write size to no more than 0xffff blocks. |
| cur = min((lbaint_t)MMC_BLOCK_COUNT_MAX, cur); |
| if (mmc_write_blocks(mmc, start, cur, src) != cur) |
| return 0; |
| |
| blocks_todo -= cur; |
| start += cur; |
| src += cur * mmc->write_bl_len; |
| } while (blocks_todo > 0); |
| return blkcnt; |
| } |