1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2013 Henrik Nordstrom <henrik@henriknordstrom.net>
13 #include <sandboxblockdev.h>
14 #include <dm/device_compat.h>
15 #include <linux/errno.h>
16 #include <dm/device-internal.h>
18 DECLARE_GLOBAL_DATA_PTR;
21 static struct host_block_dev host_devices[CONFIG_HOST_MAX_DEVICES];
23 static struct host_block_dev *find_host_device(int dev)
25 if (dev >= 0 && dev < CONFIG_HOST_MAX_DEVICES)
26 return &host_devices[dev];
33 static unsigned long host_block_read(struct udevice *dev,
34 unsigned long start, lbaint_t blkcnt,
37 struct host_block_dev *host_dev = dev_get_plat(dev);
38 struct blk_desc *block_dev = dev_get_uclass_plat(dev);
41 static unsigned long host_block_read(struct blk_desc *block_dev,
42 unsigned long start, lbaint_t blkcnt,
45 int dev = block_dev->devnum;
46 struct host_block_dev *host_dev = find_host_device(dev);
52 if (os_lseek(host_dev->fd, start * block_dev->blksz, OS_SEEK_SET) ==
54 printf("ERROR: Invalid block %lx\n", start);
57 ssize_t len = os_read(host_dev->fd, buffer, blkcnt * block_dev->blksz);
59 return len / block_dev->blksz;
64 static unsigned long host_block_write(struct udevice *dev,
65 unsigned long start, lbaint_t blkcnt,
68 struct host_block_dev *host_dev = dev_get_plat(dev);
69 struct blk_desc *block_dev = dev_get_uclass_plat(dev);
71 static unsigned long host_block_write(struct blk_desc *block_dev,
72 unsigned long start, lbaint_t blkcnt,
75 int dev = block_dev->devnum;
76 struct host_block_dev *host_dev = find_host_device(dev);
79 if (os_lseek(host_dev->fd, start * block_dev->blksz, OS_SEEK_SET) ==
81 printf("ERROR: Invalid block %lx\n", start);
84 ssize_t len = os_write(host_dev->fd, buffer, blkcnt * block_dev->blksz);
86 return len / block_dev->blksz;
91 int host_dev_bind(int devnum, char *filename)
93 struct host_block_dev *host_dev;
95 struct blk_desc *desc;
96 char dev_name[20], *str, *fname;
99 /* Remove and unbind the old device, if any */
100 ret = blk_get_device(IF_TYPE_HOST, devnum, &dev);
102 ret = device_remove(dev, DM_REMOVE_NORMAL);
105 ret = device_unbind(dev);
108 } else if (ret != -ENODEV) {
115 snprintf(dev_name, sizeof(dev_name), "host%d", devnum);
116 str = strdup(dev_name);
119 fname = strdup(filename);
125 fd = os_open(filename, OS_O_RDWR);
127 printf("Failed to access host backing file '%s'\n", filename);
131 ret = blk_create_device(gd->dm_root, "sandbox_host_blk", str,
132 IF_TYPE_HOST, devnum, 512,
133 os_lseek(fd, 0, OS_SEEK_END) / 512, &dev);
137 host_dev = dev_get_plat(dev);
139 host_dev->filename = fname;
141 ret = device_probe(dev);
147 desc = blk_get_devnum_by_type(IF_TYPE_HOST, devnum);
149 snprintf(desc->vendor, BLK_VEN_SIZE, "U-Boot");
150 snprintf(desc->product, BLK_PRD_SIZE, "hostfile");
151 snprintf(desc->revision, BLK_REV_SIZE, "1.0");
162 int host_dev_bind(int dev, char *filename)
164 struct host_block_dev *host_dev = find_host_device(dev);
168 if (host_dev->blk_dev.priv) {
169 os_close(host_dev->fd);
170 host_dev->blk_dev.priv = NULL;
172 if (host_dev->filename)
173 free(host_dev->filename);
174 if (filename && *filename) {
175 host_dev->filename = strdup(filename);
177 host_dev->filename = NULL;
181 host_dev->fd = os_open(host_dev->filename, OS_O_RDWR);
182 if (host_dev->fd == -1) {
183 printf("Failed to access host backing file '%s'\n",
188 struct blk_desc *blk_dev = &host_dev->blk_dev;
189 blk_dev->if_type = IF_TYPE_HOST;
190 blk_dev->priv = host_dev;
191 blk_dev->blksz = 512;
192 blk_dev->lba = os_lseek(host_dev->fd, 0, OS_SEEK_END) / blk_dev->blksz;
193 blk_dev->block_read = host_block_read;
194 blk_dev->block_write = host_block_write;
195 blk_dev->devnum = dev;
196 blk_dev->part_type = PART_TYPE_UNKNOWN;
197 blk_dev->removable = 1;
198 snprintf(blk_dev->vendor, BLK_VEN_SIZE, "U-Boot");
199 snprintf(blk_dev->product, BLK_PRD_SIZE, "hostfile");
200 snprintf(blk_dev->revision, BLK_REV_SIZE, "1.0");
207 int host_get_dev_err(int devnum, struct blk_desc **blk_devp)
213 ret = blk_get_device(IF_TYPE_HOST, devnum, &dev);
216 *blk_devp = dev_get_uclass_plat(dev);
218 struct host_block_dev *host_dev = find_host_device(devnum);
223 if (!host_dev->blk_dev.priv)
226 *blk_devp = &host_dev->blk_dev;
233 static const struct blk_ops sandbox_host_blk_ops = {
234 .read = host_block_read,
235 .write = host_block_write,
238 U_BOOT_DRIVER(sandbox_host_blk) = {
239 .name = "sandbox_host_blk",
241 .ops = &sandbox_host_blk_ops,
242 .plat_auto = sizeof(struct host_block_dev),
245 U_BOOT_LEGACY_BLK(sandbox_host) = {
246 .if_typename = "host",
247 .if_type = IF_TYPE_HOST,
248 .max_devs = CONFIG_HOST_MAX_DEVICES,
249 .get_dev = host_get_dev_err,