From mboxrd@z Thu Jan 1 00:00:00 1970 From: Marek Vasut Date: Fri, 7 Sep 2012 01:29:55 +0200 Subject: [U-Boot] [PATCH v4 1/2] Loop block device for sandbox In-Reply-To: <1346934680-29178-1-git-send-email-morpheus.ibis@gmail.com> References: <1346843795-4744-1-git-send-email-morpheus.ibis@gmail.com> <1346934680-29178-1-git-send-email-morpheus.ibis@gmail.com> Message-ID: <201209070129.56003.marex@denx.de> List-Id: MIME-Version: 1.0 Content-Type: text/plain; charset="us-ascii" Content-Transfer-Encoding: 7bit To: u-boot@lists.denx.de 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 > CC: Marek Vasut > CC: Mike Frysinger > --- > 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 > + * > + * 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 > +#include > +#include > +#include > +#include > +#include > +#include > +#include > + > +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