2 * Copyright (C) 2013 Samsung Electronics
3 * Lukasz Majewski <l.majewski@samsung.com>
5 * SPDX-License-Identifier: GPL-2.0+
9 #include <usb_mass_storage.h>
12 static int ums_read_sector(struct ums *ums_dev,
13 ulong start, lbaint_t blkcnt, void *buf)
15 block_dev_desc_t *block_dev = &ums_dev->mmc->block_dev;
16 lbaint_t blkstart = start + ums_dev->start_sector;
17 int dev_num = block_dev->dev;
19 return block_dev->block_read(dev_num, blkstart, blkcnt, buf);
22 static int ums_write_sector(struct ums *ums_dev,
23 ulong start, lbaint_t blkcnt, const void *buf)
25 block_dev_desc_t *block_dev = &ums_dev->mmc->block_dev;
26 lbaint_t blkstart = start + ums_dev->start_sector;
27 int dev_num = block_dev->dev;
29 return block_dev->block_write(dev_num, blkstart, blkcnt, buf);
32 static struct ums ums_dev = {
33 .read_sector = ums_read_sector,
34 .write_sector = ums_write_sector,
38 static struct ums *ums_disk_init(struct mmc *mmc)
40 uint64_t mmc_end_sector = mmc->capacity / SECTOR_SIZE;
41 uint64_t ums_end_sector = UMS_NUM_SECTORS + UMS_START_SECTOR;
43 if (!mmc_end_sector) {
44 error("MMC capacity is not valid");
50 if (ums_end_sector <= mmc_end_sector) {
51 ums_dev.start_sector = UMS_START_SECTOR;
53 ums_dev.num_sectors = UMS_NUM_SECTORS;
55 ums_dev.num_sectors = mmc_end_sector - UMS_START_SECTOR;
57 ums_dev.num_sectors = mmc_end_sector;
58 puts("UMS: defined bad disk parameters. Using default.\n");
61 printf("UMS: disk start sector: %#x, count: %#x\n",
62 ums_dev.start_sector, ums_dev.num_sectors);
67 struct ums *ums_init(unsigned int dev_num)
69 struct mmc *mmc = NULL;
71 mmc = find_mmc_device(dev_num);
75 return ums_disk_init(mmc);