From: Richard Weinberger <rich...@nod.at> Add a small UML driver to act as nandsim backend. This allows us to use the nandsim MTD as root device and boot from it. e.g. ./linux mem=512M unand.backing_file=/home/rw/work/ubifs/mtd4.raw \ unand.id_bytes=0x1c,0xd3,0x90,0xa6 unand.no_oob=y nandsim.defaults=n \ ubi.mtd=0 rootfstype=ubifs root=ubi0:rootfs
Signed-off-by: Richard Weinberger <rich...@nod.at> --- arch/um/Kconfig.um | 6 ++ arch/um/drivers/Makefile | 2 + arch/um/drivers/nand_kern.c | 159 ++++++++++++++++++++++++++++++++++++++++++++ 3 files changed, 167 insertions(+) create mode 100644 arch/um/drivers/nand_kern.c diff --git a/arch/um/Kconfig.um b/arch/um/Kconfig.um index 4b2ed58..f7a1a17 100644 --- a/arch/um/Kconfig.um +++ b/arch/um/Kconfig.um @@ -44,6 +44,12 @@ config HOSTFS If you'd like to be able to work with files stored on the host, say Y or M here; otherwise say N. +config UML_NANDSIM + tristate "UML nandsim backend" + help + Use a file on the host directly as backend for nandsim. + For more help, see modinfo unand. + config MCONSOLE bool "Management console" depends on PROC_FS diff --git a/arch/um/drivers/Makefile b/arch/um/drivers/Makefile index e7582e1..08a806e 100644 --- a/arch/um/drivers/Makefile +++ b/arch/um/drivers/Makefile @@ -16,6 +16,7 @@ hostaudio-objs := hostaudio_kern.o ubd-objs := ubd_kern.o ubd_user.o port-objs := port_kern.o port_user.o harddog-objs := harddog_kern.o harddog_user.o +unand-objs := nand_kern.o LDFLAGS_pcap.o := -r $(shell $(CC) $(KBUILD_CFLAGS) -print-file-name=libpcap.a) @@ -59,6 +60,7 @@ obj-$(CONFIG_XTERM_CHAN) += xterm.o xterm_kern.o obj-$(CONFIG_UML_WATCHDOG) += harddog.o obj-$(CONFIG_BLK_DEV_COW_COMMON) += cow_user.o obj-$(CONFIG_UML_RANDOM) += random.o +obj-$(CONFIG_UML_NANDSIM) += unand.o # pcap_user.o must be added explicitly. USER_OBJS := fd.o null.o pty.o tty.o xterm.o slip_common.o pcap_user.o vde_user.o diff --git a/arch/um/drivers/nand_kern.c b/arch/um/drivers/nand_kern.c new file mode 100644 index 0000000..399d9e6 --- /dev/null +++ b/arch/um/drivers/nand_kern.c @@ -0,0 +1,159 @@ +#include <linux/module.h> +#include <linux/slab.h> +#include <linux/mtd/mtd.h> +#include <linux/mtd/nandsim.h> +#include <init.h> +#include <os.h> + +static u_char id_bytes[8] = { + [0 ... 7] = 0xFF, +}; +static bool no_oob; +static char *backing_file; +static unsigned int bus_width; + +module_param_array(id_bytes, byte, NULL, 0400); +module_param(no_oob, bool, 0400); +module_param(backing_file, charp, 0400); +module_param(bus_width, uint, 0400); + +MODULE_PARM_DESC(backing_file, "File to use as backing store"); +MODULE_PARM_DESC(id_bytes, "The ID bytes returned by NAND Flash 'read ID' command"); +MODULE_PARM_DESC(no_oob, "Set to use an image without OOB data, i.e created by nanddump"); +MODULE_PARM_DESC(bus_width, "Chip's bus width (8- or 16-bit)"); + +struct ns_uml_data { + int fd; + void *file_buf; +}; + +/* + * We support only one instance so far, just to boot from MTD. + * If you need more MTDs, use nandsimctl(8). + */ +static struct mtd_info *nsmtd; + +static int file_read(struct nandsim *ns, char *addr, unsigned long count, + loff_t offset) +{ + struct ns_uml_data *data = nandsim_get_backend_data(ns); + + return os_pread_file(data->fd, addr, count, offset); +} + +static ssize_t file_write(struct nandsim *ns, const char *addr, size_t count, + loff_t offset) +{ + struct ns_uml_data *data = nandsim_get_backend_data(ns); + + return os_pwrite_file(data->fd, addr, count, offset); +} + +static void ns_uml_read_page(struct nandsim *ns, int num) +{ + __ns_file_read_page(ns, num, file_read); +} + +static int ns_uml_prog_page(struct nandsim *ns, int num) +{ + struct ns_uml_data *data = nandsim_get_backend_data(ns); + + return __ns_file_prog_page(ns, num, data->file_buf, file_read, + file_write); +} + +static void ns_uml_erase_sector(struct nandsim *ns) +{ + struct ns_uml_data *data = nandsim_get_backend_data(ns); + + __ns_file_erase_sector(ns, data->file_buf, file_write); +} + +static int ns_uml_init(struct nandsim *ns, struct nandsim_params *nsparam) +{ + struct ns_uml_data *data = kzalloc(sizeof(*data), GFP_KERNEL); + + if (!data) + return -ENOMEM; + + data->file_buf = kmalloc(nandsim_get_geom(ns)->pgszoob, GFP_KERNEL); + if (!data->file_buf) { + kfree(data); + return -ENOMEM; + } + + data->fd = os_open_file(nsparam->cache_file, of_set_rw(OPENFLAGS(), 1, 1), 0); + if (data->fd < 0) { + printk(KERN_ERR "Unable to open %s: %i\n", nsparam->cache_file, data->fd); + kfree(data->file); + kfree(data); + return data->fd; + } + + nandsim_set_backend_data(ns, data); + + return 0; +} + +static void ns_uml_destroy(struct nandsim *ns) +{ + struct ns_uml_data *data = nandsim_get_backend_data(ns); + + if (!data) + return; + + os_close_file(data->fd); + kfree(data->file_buf); + kfree(data); +} + +static struct ns_backend_ops ns_uml_bops = { + .erase_sector = ns_uml_erase_sector, + .prog_page = ns_uml_prog_page, + .read_page = ns_uml_read_page, + .init = ns_uml_init, + .destroy = ns_uml_destroy, + .name = "uml", +}; + +static struct nandsim_params params = { + .bops = &ns_uml_bops, +}; + +static int __init uml_ns_init(void) +{ + struct mtd_info *ret; + + if (!backing_file) + return 0; + + params.cache_file = backing_file; + params.bus_width = bus_width; + params.no_oob = no_oob; + memcpy(params.id_bytes, id_bytes, sizeof(params.id_bytes)); + + ret = ns_new_instance(¶ms); + if (IS_ERR(ret)) + return PTR_ERR(ret); + + nsmtd = ret; + + return 0; +} +late_initcall(uml_ns_init); + +static void __exit uml_ns_exit(void) +{ + /* + * Since this driver is a singleton we can rely on module refcounting, + * and assume that ns_destroy_instance() will succeed in any case. + * If not, print a frindly warning. B-) + */ + WARN_ON(ns_destroy_instance(nsmtd) != 0); +} +module_exit(uml_ns_exit); + +MODULE_AUTHOR("Richard Weinberger"); +MODULE_DESCRIPTION("UML nandsim backend"); +MODULE_LICENSE("GPL"); + -- 2.8.3