| // SPDX-License-Identifier: GPL-2.0+ | |
| /* | |
| * Copyright (C) 2013 Henrik Nordstrom <henrik@henriknordstrom.net> | |
| */ | |
| #include <common.h> | |
| #include <blk.h> | |
| #include <dm.h> | |
| #include <fdtdec.h> | |
| #include <part.h> | |
| #include <os.h> | |
| #include <malloc.h> | |
| #include <sandbox_host.h> | |
| #include <asm/global_data.h> | |
| #include <dm/device_compat.h> | |
| #include <dm/device-internal.h> | |
| #include <linux/errno.h> | |
| DECLARE_GLOBAL_DATA_PTR; | |
| static unsigned long host_block_read(struct udevice *dev, | |
| unsigned long start, lbaint_t blkcnt, | |
| void *buffer) | |
| { | |
| struct blk_desc *desc = dev_get_uclass_plat(dev); | |
| struct udevice *host_dev = dev_get_parent(dev); | |
| struct host_sb_plat *plat = dev_get_plat(host_dev); | |
| if (os_lseek(plat->fd, start * desc->blksz, OS_SEEK_SET) == -1) { | |
| printf("ERROR: Invalid block %lx\n", start); | |
| return -1; | |
| } | |
| ssize_t len = os_read(plat->fd, buffer, blkcnt * desc->blksz); | |
| if (len >= 0) | |
| return len / desc->blksz; | |
| return -EIO; | |
| } | |
| static unsigned long host_block_write(struct udevice *dev, | |
| unsigned long start, lbaint_t blkcnt, | |
| const void *buffer) | |
| { | |
| struct blk_desc *desc = dev_get_uclass_plat(dev); | |
| struct udevice *host_dev = dev_get_parent(dev); | |
| struct host_sb_plat *plat = dev_get_plat(host_dev); | |
| if (os_lseek(plat->fd, start * desc->blksz, OS_SEEK_SET) == -1) { | |
| printf("ERROR: Invalid block %lx\n", start); | |
| return -1; | |
| } | |
| ssize_t len = os_write(plat->fd, buffer, blkcnt * desc->blksz); | |
| if (len >= 0) | |
| return len / desc->blksz; | |
| return -EIO; | |
| } | |
| static const struct blk_ops sandbox_host_blk_ops = { | |
| .read = host_block_read, | |
| .write = host_block_write, | |
| }; | |
| U_BOOT_DRIVER(sandbox_host_blk) = { | |
| .name = "sandbox_host_blk", | |
| .id = UCLASS_BLK, | |
| .ops = &sandbox_host_blk_ops, | |
| }; |