Dear Pavel Herrmann,
This driver uses files as block devices, can be used for testing disk operations on sandbox. A new command "sata_loop" is introduced to load files in runtime.
WARNING: externs should be avoided in .c files #141: FILE: drivers/block/sata_loopback.c:39: +extern block_dev_desc_t sata_dev_desc[];
total: 0 errors, 1 warnings, 231 lines checked
NOTE: Ignored message types: COMPLEX_MACRO CONSIDER_KSTRTO MINMAX MULTISTATEMENT_MACRO_USE_DO_WHILE
Signed-off-by: Pavel Herrmann morpheus.ibis@gmail.com CC: Marek Vasut marex@denx.de CC: Mike Frysinger vapier@gentoo.org
Changes for v4: checkpatch fixes use NULLs instead of "" extend sata_loop command
Changes for v3: introduce sata_loop command
Changes for v2: split sandbox config off into separate patch (2/2) rename file to signify exported API style fixes show end of long filenames rather than beginning check for lseek errors to indicate non-regular file
drivers/block/Makefile | 1 + drivers/block/sata_loopback.c | 212 ++++++++++++++++++++++++++++++++++++++++++ include/configs/sandbox.h | 8 ++ 3 files changed, 221 insertions(+) create mode 100644 drivers/block/sata_loopback.c
diff --git a/drivers/block/Makefile b/drivers/block/Makefile index f1ebdcc..c95651a 100644 --- a/drivers/block/Makefile +++ b/drivers/block/Makefile @@ -40,6 +40,7 @@ COBJS-$(CONFIG_SATA_SIL) += sata_sil.o COBJS-$(CONFIG_IDE_SIL680) += sil680.o COBJS-$(CONFIG_SCSI_SYM53C8XX) += sym53c8xx.o COBJS-$(CONFIG_SYSTEMACE) += systemace.o +COBJS-${CONFIG_SATA_LOOP} += sata_loopback.o
COBJS := $(COBJS-y) SRCS := $(COBJS:.o=.c) diff --git a/drivers/block/sata_loopback.c b/drivers/block/sata_loopback.c new file mode 100644 index 0000000..600fbdc --- /dev/null +++ b/drivers/block/sata_loopback.c @@ -0,0 +1,212 @@ +/*
- (C) Copyright 2012
- Pavel Herrmann morpheus.ibis@gmail.com
- See file CREDITS for list of people who contributed to this
- project.
- This program is free software; you can redistribute it and/or
- modify it under the terms of the GNU General Public License as
- published by the Free Software Foundation; either version 2 of
- the License, or (at your option) any later version.
- This program is distributed in the hope that it will be useful,
- but WITHOUT ANY WARRANTY; without even the implied warranty of
- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- GNU General Public License for more details.
- You should have received a copy of the GNU General Public License
- along with this program; if not, write to the Free Software
- Foundation, Inc., 59 Temple Place, Suite 330, Boston,
- MA 02111-1307 USA
- */
+#include <common.h> +#include <part.h> +#include <ata.h> +#include <libata.h> +#include <errno.h> +#include <os.h> +#include <command.h> +#include <malloc.h>
+static const char revision[] = "0.0"; +static const char vendor[] = "SATA loopback";
+/* this will be auto-initialized to NULLs */ +static char *filenames[CONFIG_SYS_SATA_MAX_DEVICE];
+extern block_dev_desc_t sata_dev_desc[];
+static inline int range_check(int dev) +{
- return (dev < 0) || (dev >= CONFIG_SYS_SATA_MAX_DEVICE);
+}
+int init_sata(int dev) +{
- block_dev_desc_t *pdev = &sata_dev_desc[dev];
- int fd, old_fd;
- if (range_check(dev)) {
printf("File index %d is out of range.\n", dev);return -EINVAL;- }
- if (filenames[dev])
fd = os_open(filenames[dev], OS_O_RDWR);- else
fd = -1;- old_fd = (long) pdev->priv;
- /* This is ugly, but saves allocation for 1 int. */
- pdev->priv = (void *) (long) fd;
- if ((old_fd > 2) || (old_fd < 0))
os_close(old_fd);- return 0;
+}
+lbaint_t sata_read(int dev, lbaint_t start, lbaint_t blkcnt, void *buffer) +{
- block_dev_desc_t *pdev = &sata_dev_desc[dev];
- int fd = (long) pdev->priv;
- lbaint_t start_byte = ATA_SECT_SIZE * start;
- lbaint_t length_byte = ATA_SECT_SIZE * blkcnt;
- lbaint_t retval;
- if (os_lseek(fd, start_byte, OS_SEEK_SET) != start_byte)
return -1;- retval = os_read(fd, buffer, length_byte);
- return retval / ATA_SECT_SIZE;
+}
+lbaint_t sata_write(int dev, lbaint_t start, lbaint_t blkcnt, void *buffer) +{
- block_dev_desc_t *pdev = &sata_dev_desc[dev];
- int fd = (long) pdev->priv;
- lbaint_t start_byte = ATA_SECT_SIZE * start;
- lbaint_t length_byte = ATA_SECT_SIZE * blkcnt;
- lbaint_t retval;
- if (os_lseek(fd, start_byte, OS_SEEK_SET) != start_byte)
return -1;- retval = os_write(fd, buffer, length_byte);
- return retval / ATA_SECT_SIZE;
+}
+int scan_sata(int dev) +{
- block_dev_desc_t *pdev = &sata_dev_desc[dev];
- int fd = (long) pdev->priv;
- int namelen;
- char *filename;
- lbaint_t bytes = 0;
- if (range_check(dev)) {
printf("File index %d is out of range.\n", dev);return -EINVAL;- }
- if (filenames[dev])
filename = filenames[dev];- else
filename = "";- memcpy(pdev->vendor, vendor, sizeof(vendor));
- memcpy(pdev->revision, revision, sizeof(revision));
- namelen = strlen(filename);
- if (namelen > 20) {
/* take the last 17 chars, prepend them with "..." */memcpy(pdev->product, "...", 3);memcpy(pdev->product+3, filename + (namelen - 17), 17);- } else
memcpy(pdev->product, filename, namelen);- pdev->product[20] = 0;
- bytes = os_lseek(fd, 0, OS_SEEK_END);
- if (bytes != -1) {
pdev->type = DEV_TYPE_HARDDISK;pdev->blksz = ATA_SECT_SIZE;pdev->lun = 0;pdev->lba = bytes/ATA_SECT_SIZE;printf("SATA loop %d:\nfilename: %s\nsize: %lu\nblock count:"" %lu\n", dev, filename, bytes, pdev->lba);- } else {
pdev->type = DEV_TYPE_HARDDISK;pdev->blksz = ATA_SECT_SIZE;pdev->lun = 0;pdev->lba = 0;printf("SATA loop %d:\nfilename: %s\nFAILED TO OPEN\n",dev, filename);- }
- return 0;
+}
+int do_loop(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) +{
- int dev = 0;
- switch (argc) {
- case 0:
- case 1:
return CMD_RET_USAGE;- case 2:
if (!strncmp(argv[1], "inf", 3)) {for (dev = 0; dev < CONFIG_SYS_SATA_MAX_DEVICE; dev++)scan_sata(dev);return 0;}return CMD_RET_USAGE;- case 3:
if (!strncmp(argv[1], "inf", 3)) {dev = simple_strtoul(argv[2], NULL, 10);return scan_sata(dev);}return CMD_RET_USAGE;- case 4:
if (!strncmp(argv[1], "load", 4)) {dev = simple_strtoul(argv[2], NULL, 10);/** init_sata() and scan_sata() do their own range* check, however we need to explicitly do it here* as well.*/if (range_check(dev)) {printf("File index %d is out of range.\n", dev);return -EINVAL;}free(filenames[dev]);filenames[dev] = strdup(argv[3]);init_sata(dev);scan_sata(dev);/** Scan the partition table if we succeeded in loading* the new loop file.*/if (sata_dev_desc[dev].lba > 0)init_part(&sata_dev_desc[dev]);return 0;}return CMD_RET_USAGE;- }
- return CMD_RET_USAGE;
+}
+U_BOOT_CMD(
- sata_loop, 4, 1, do_loop,
- "SATA loopback",
- "info - show info about all loop devices\n"
- "sata_loop info devnum - show info about loop devnum\n"
- "sata_loop load devnum file - load file from host FS into loop devnum"
+); diff --git a/include/configs/sandbox.h b/include/configs/sandbox.h index 0220386..a713430 100644 --- a/include/configs/sandbox.h +++ b/include/configs/sandbox.h @@ -93,4 +93,12 @@ "stdout=serial\0" \ "stderr=serial\0"
+/* SATA loopback device */ +#define CONFIG_CMD_SATA +#define CONFIG_SATA_LOOP +#define CONFIG_SYS_SATA_MAX_DEVICE 2 +#define CONFIG_DOS_PARTITION +#define CONFIG_CMD_FAT +#define CONFIG_CMD_EXT2
#endif