From mboxrd@z Thu Jan 1 00:00:00 1970 From: Lukasz Majewski Date: Wed, 13 Jul 2011 16:29:52 +0200 Subject: [U-Boot] [PATCH v2 5/5] usb:gadget:s5p Support for USB Mass Storage Gadget on GONI In-Reply-To: <1310567392-29082-1-git-send-email-l.majewski@samsung.com> References: <1310567392-29082-1-git-send-email-l.majewski@samsung.com> Message-ID: <1310567392-29082-6-git-send-email-l.majewski@samsung.com> List-Id: MIME-Version: 1.0 Content-Type: text/plain; charset="us-ascii" Content-Transfer-Encoding: 7bit To: u-boot@lists.denx.de This patch adds support for USB Mass Storage Gadget on the Samsung's GONI reference target Signed-off-by: Lukasz Majewski Signed-off-by: Kyungmin Park Cc: Remy Bohmer Cc: Minkyu Kang --- board/samsung/goni/goni.c | 68 ++++++++++++++++++++++++++++++++++++++++++++ include/configs/s5p_goni.h | 6 ++++ 2 files changed, 74 insertions(+), 0 deletions(-) diff --git a/board/samsung/goni/goni.c b/board/samsung/goni/goni.c index 2935bd7..469b1e8 100644 --- a/board/samsung/goni/goni.c +++ b/board/samsung/goni/goni.c @@ -29,6 +29,8 @@ #include #include +#include + DECLARE_GLOBAL_DATA_PTR; static struct s5pc110_gpio *s5pc110_gpio; @@ -220,3 +222,69 @@ struct s3c_plat_otg_data s5pc110_otg_data = { .regs_otg = S5PC110_OTG_BASE, }; #endif + +#ifdef CONFIG_USB_GADGET_MASS_STORAGE +static int ums_read_sector(struct ums_device *ums_dev, + unsigned int n, void *buf) +{ + if (ums_dev->mmc->block_dev.block_read(ums_dev->dev_num, + n + ums_dev->offset, 1, buf) != 1) + return -1; + + return 0; +} + +static int ums_write_sector(struct ums_device *ums_dev, + unsigned int n, void *buf) +{ + if (ums_dev->mmc->block_dev.block_write(ums_dev->dev_num, + n + ums_dev->offset, 1, buf) != 1) + return -1; + + return 0; +} + +static void ums_get_capacity(struct ums_device *ums_dev, + long long int *capacity) +{ + long long int tmp_capacity; + + tmp_capacity = (long long int) ((ums_dev->offset + ums_dev->part_size) + * SECTOR_SIZE); + *capacity = ums_dev->mmc->capacity - tmp_capacity; +} + +static struct ums_board_info ums_board = { + .read_sector = ums_read_sector, + .write_sector = ums_write_sector, + .get_capacity = ums_get_capacity, + .name = "GONI UMS disk", + .ums_dev = { + .mmc = NULL, + .dev_num = 0, + .offset = 0, + .part_size = 0. + }, +}; + +struct ums_board_info *board_ums_init(unsigned int dev_num, unsigned int offset, + unsigned int part_size) +{ + struct mmc *mmc; + + mmc = find_mmc_device(dev_num); + if (!mmc) + return NULL; + + ums_board.ums_dev.mmc = mmc; + ums_board.ums_dev.dev_num = dev_num; + ums_board.ums_dev.offset = offset; + ums_board.ums_dev.part_size = part_size; + + /* Init MMC */ + mmc_init(mmc); + + s3c_udc_probe(&s5pc110_otg_data); + return &ums_board; +} +#endif diff --git a/include/configs/s5p_goni.h b/include/configs/s5p_goni.h index a47d0b4..8a7bed3 100644 --- a/include/configs/s5p_goni.h +++ b/include/configs/s5p_goni.h @@ -91,6 +91,8 @@ #define CONFIG_CMD_MTDPARTS #define CONFIG_CMD_MMC +#define CONFIG_CMD_USB_MASS_STORAGE + #define CONFIG_BOOTDELAY 1 #define CONFIG_ZERO_BOOTDELAY_CHECK @@ -241,4 +243,8 @@ #define CONFIG_USB_GADGET_S3C_UDC_OTG 1 #define CONFIG_USB_GADGET_DUALSPEED 1 +#if defined(CONFIG_CMD_USB_MASS_STORAGE) +#define CONFIG_USB_GADGET_MASS_STORAGE +#endif + #endif /* __CONFIG_H */ -- 1.7.2.3