1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2013 Henrik Nordstrom <henrik@henriknordstrom.net>
13 #include <sandboxblockdev.h>
14 #include <asm/global_data.h>
15 #include <dm/device_compat.h>
16 #include <linux/errno.h>
17 #include <dm/device-internal.h>
19 DECLARE_GLOBAL_DATA_PTR;
22 static struct host_block_dev host_devices[CONFIG_HOST_MAX_DEVICES];
24 static struct host_block_dev *find_host_device(int dev)
26 if (dev >= 0 && dev < CONFIG_HOST_MAX_DEVICES)
27 return &host_devices[dev];
34 static unsigned long host_block_read(struct udevice *dev,
35 unsigned long start, lbaint_t blkcnt,
38 struct host_block_dev *host_dev = dev_get_plat(dev);
39 struct blk_desc *block_dev = dev_get_uclass_plat(dev);
42 static unsigned long host_block_read(struct blk_desc *block_dev,
43 unsigned long start, lbaint_t blkcnt,
46 int dev = block_dev->devnum;
47 struct host_block_dev *host_dev = find_host_device(dev);
53 if (os_lseek(host_dev->fd, start * block_dev->blksz, OS_SEEK_SET) ==
55 printf("ERROR: Invalid block %lx\n", start);
58 ssize_t len = os_read(host_dev->fd, buffer, blkcnt * block_dev->blksz);
60 return len / block_dev->blksz;
65 static unsigned long host_block_write(struct udevice *dev,
66 unsigned long start, lbaint_t blkcnt,
69 struct host_block_dev *host_dev = dev_get_plat(dev);
70 struct blk_desc *block_dev = dev_get_uclass_plat(dev);
72 static unsigned long host_block_write(struct blk_desc *block_dev,
73 unsigned long start, lbaint_t blkcnt,
76 int dev = block_dev->devnum;
77 struct host_block_dev *host_dev = find_host_device(dev);
80 if (os_lseek(host_dev->fd, start * block_dev->blksz, OS_SEEK_SET) ==
82 printf("ERROR: Invalid block %lx\n", start);
85 ssize_t len = os_write(host_dev->fd, buffer, blkcnt * block_dev->blksz);
87 return len / block_dev->blksz;
92 int host_dev_bind(int devnum, char *filename)
94 struct host_block_dev *host_dev;
96 struct blk_desc *desc;
97 char dev_name[20], *str, *fname;
100 /* Remove and unbind the old device, if any */
101 ret = blk_get_device(IF_TYPE_HOST, devnum, &dev);
103 ret = device_remove(dev, DM_REMOVE_NORMAL);
106 ret = device_unbind(dev);
109 } else if (ret != -ENODEV) {
116 snprintf(dev_name, sizeof(dev_name), "host%d", devnum);
117 str = strdup(dev_name);
120 fname = strdup(filename);
126 fd = os_open(filename, OS_O_RDWR);
128 printf("Failed to access host backing file '%s'\n", filename);
132 ret = blk_create_device(gd->dm_root, "sandbox_host_blk", str,
133 IF_TYPE_HOST, devnum, 512,
134 os_lseek(fd, 0, OS_SEEK_END) / 512, &dev);
138 host_dev = dev_get_plat(dev);
140 host_dev->filename = fname;
142 ret = device_probe(dev);
148 desc = blk_get_devnum_by_type(IF_TYPE_HOST, devnum);
150 snprintf(desc->vendor, BLK_VEN_SIZE, "U-Boot");
151 snprintf(desc->product, BLK_PRD_SIZE, "hostfile");
152 snprintf(desc->revision, BLK_REV_SIZE, "1.0");
163 int host_dev_bind(int dev, char *filename)
165 struct host_block_dev *host_dev = find_host_device(dev);
169 if (host_dev->blk_dev.priv) {
170 os_close(host_dev->fd);
171 host_dev->blk_dev.priv = NULL;
173 if (host_dev->filename)
174 free(host_dev->filename);
175 if (filename && *filename) {
176 host_dev->filename = strdup(filename);
178 host_dev->filename = NULL;
182 host_dev->fd = os_open(host_dev->filename, OS_O_RDWR);
183 if (host_dev->fd == -1) {
184 printf("Failed to access host backing file '%s'\n",
189 struct blk_desc *blk_dev = &host_dev->blk_dev;
190 blk_dev->if_type = IF_TYPE_HOST;
191 blk_dev->priv = host_dev;
192 blk_dev->blksz = 512;
193 blk_dev->lba = os_lseek(host_dev->fd, 0, OS_SEEK_END) / blk_dev->blksz;
194 blk_dev->block_read = host_block_read;
195 blk_dev->block_write = host_block_write;
196 blk_dev->devnum = dev;
197 blk_dev->part_type = PART_TYPE_UNKNOWN;
198 blk_dev->removable = 1;
199 snprintf(blk_dev->vendor, BLK_VEN_SIZE, "U-Boot");
200 snprintf(blk_dev->product, BLK_PRD_SIZE, "hostfile");
201 snprintf(blk_dev->revision, BLK_REV_SIZE, "1.0");
208 int host_get_dev_err(int devnum, struct blk_desc **blk_devp)
214 ret = blk_get_device(IF_TYPE_HOST, devnum, &dev);
217 *blk_devp = dev_get_uclass_plat(dev);
219 struct host_block_dev *host_dev = find_host_device(devnum);
224 if (!host_dev->blk_dev.priv)
227 *blk_devp = &host_dev->blk_dev;
234 static const struct blk_ops sandbox_host_blk_ops = {
235 .read = host_block_read,
236 .write = host_block_write,
239 U_BOOT_DRIVER(sandbox_host_blk) = {
240 .name = "sandbox_host_blk",
242 .ops = &sandbox_host_blk_ops,
243 .plat_auto = sizeof(struct host_block_dev),
246 U_BOOT_LEGACY_BLK(sandbox_host) = {
247 .if_typename = "host",
248 .if_type = IF_TYPE_HOST,
249 .max_devs = CONFIG_HOST_MAX_DEVICES,
250 .get_dev = host_get_dev_err,