[net-next-2.6.git] / drivers / mtd / maps / uclinux.c

/****************************************************************************/

/*
 *	uclinux.c -- generic memory mapped MTD driver for uclinux
 *
 *	(C) Copyright 2002, Greg Ungerer (gerg@snapgear.com)
 */

/****************************************************************************/

#include <linux/module.h>
#include <linux/types.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/fs.h>
#include <linux/mm.h>
#include <linux/major.h>
#include <linux/mtd/mtd.h>
#include <linux/mtd/map.h>
#include <linux/mtd/partitions.h>
#include <asm/io.h>

/****************************************************************************/

extern char _ebss;

struct map_info uclinux_ram_map = {
	.name = "RAM",
	.phys = (unsigned long)&_ebss,
	.size = 0,
};

static struct mtd_info *uclinux_ram_mtdinfo;

/****************************************************************************/

static struct mtd_partition uclinux_romfs[] = {
	{ .name = "ROMfs" }
};

#define	NUM_PARTITIONS	ARRAY_SIZE(uclinux_romfs)

/****************************************************************************/

static int uclinux_point(struct mtd_info *mtd, loff_t from, size_t len,
	size_t *retlen, void **virt, resource_size_t *phys)
{
	struct map_info *map = mtd->priv;
	*virt = map->virt + from;
	if (phys)
		*phys = map->phys + from;
	*retlen = len;
	return(0);
}

/****************************************************************************/

static int __init uclinux_mtd_init(void)
{
	struct mtd_info *mtd;
	struct map_info *mapp;

	mapp = &uclinux_ram_map;
	if (!mapp->size)
		mapp->size = PAGE_ALIGN(ntohl(*((unsigned long *)(mapp->phys + 8))));
	mapp->bankwidth = 4;

	printk("uclinux[mtd]: RAM probe address=0x%x size=0x%x\n",
	       	(int) mapp->phys, (int) mapp->size);

	mapp->virt = ioremap_nocache(mapp->phys, mapp->size);

	if (mapp->virt == 0) {
		printk("uclinux[mtd]: ioremap_nocache() failed\n");
		return(-EIO);
	}

	simple_map_init(mapp);

	mtd = do_map_probe("map_ram", mapp);
	if (!mtd) {
		printk("uclinux[mtd]: failed to find a mapping?\n");
		iounmap(mapp->virt);
		return(-ENXIO);
	}

	mtd->owner = THIS_MODULE;
	mtd->point = uclinux_point;
	mtd->priv = mapp;

	uclinux_ram_mtdinfo = mtd;
#ifdef CONFIG_MTD_PARTITIONS
	add_mtd_partitions(mtd, uclinux_romfs, NUM_PARTITIONS);
#else
	add_mtd_device(mtd);
#endif

	return(0);
}

/****************************************************************************/

static void __exit uclinux_mtd_cleanup(void)
{
	if (uclinux_ram_mtdinfo) {
#ifdef CONFIG_MTD_PARTITIONS
		del_mtd_partitions(uclinux_ram_mtdinfo);
#else
		del_mtd_device(uclinux_ram_mtdinfo);
#endif
		map_destroy(uclinux_ram_mtdinfo);
		uclinux_ram_mtdinfo = NULL;
	}
	if (uclinux_ram_map.virt) {
		iounmap((void *) uclinux_ram_map.virt);
		uclinux_ram_map.virt = 0;
	}
}

/****************************************************************************/

module_init(uclinux_mtd_init);
module_exit(uclinux_mtd_cleanup);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Greg Ungerer <gerg@snapgear.com>");
MODULE_DESCRIPTION("Generic RAM based MTD for uClinux");

/****************************************************************************/
Commit	Line	Data
1da177e4 LT	1	/****************************************************************************/
	2
	3	/*
	4	* uclinux.c -- generic memory mapped MTD driver for uclinux
	5	*
	6	* (C) Copyright 2002, Greg Ungerer (gerg@snapgear.com)
1da177e4 LT	7	*/
	8
	9	/****************************************************************************/
	10
1da177e4 LT	11	#include <linux/module.h>
	12	#include <linux/types.h>
	13	#include <linux/init.h>
	14	#include <linux/kernel.h>
	15	#include <linux/fs.h>
27ac792c	16	#include <linux/mm.h>
1da177e4	17	#include <linux/major.h>
1da177e4 LT	18	#include <linux/mtd/mtd.h>
	19	#include <linux/mtd/map.h>
	20	#include <linux/mtd/partitions.h>
	21	#include <asm/io.h>
	22
1da177e4 LT	23	/****************************************************************************/
1da177e4 LT	24
fa254ecb MF	25	extern char _ebss;
fa254ecb MF	26
1da177e4 LT	27	struct map_info uclinux_ram_map = {
1da177e4 LT	28	.name = "RAM",
fa254ecb MF	29	.phys = (unsigned long)&_ebss,
fa254ecb MF	30	.size = 0,
1da177e4 LT	31	};
1da177e4 LT	32
9f31f4b9	33	static struct mtd_info *uclinux_ram_mtdinfo;
1da177e4 LT	34
	35	/****************************************************************************/
	36
9f31f4b9	37	static struct mtd_partition uclinux_romfs[] = {
1da177e4 LT	38	{ .name = "ROMfs" }
	39	};
	40
87d10f3c	41	#define NUM_PARTITIONS ARRAY_SIZE(uclinux_romfs)
1da177e4 LT	42
	43	/****************************************************************************/
	44
9f31f4b9	45	static int uclinux_point(struct mtd_info *mtd, loff_t from, size_t len,
a98889f3	46	size_t retlen, void virt, resource_size_t phys)
1da177e4 LT	47	{
1da177e4 LT	48	struct map_info *map = mtd->priv;
a98889f3 JH	49	*virt = map->virt + from;
	50	if (phys)
	51	*phys = map->phys + from;
1da177e4 LT	52	*retlen = len;
	53	return(0);
	54	}
	55
	56	/****************************************************************************/
	57
769455e2	58	static int __init uclinux_mtd_init(void)
1da177e4 LT	59	{
	60	struct mtd_info *mtd;
	61	struct map_info *mapp;
1da177e4 LT	62
1da177e4 LT	63	mapp = &uclinux_ram_map;
fa254ecb MF	64	if (!mapp->size)
fa254ecb MF	65	mapp->size = PAGE_ALIGN(ntohl(((unsigned long )(mapp->phys + 8))));
1da177e4 LT	66	mapp->bankwidth = 4;
	67
	68	printk("uclinux[mtd]: RAM probe address=0x%x size=0x%x\n",
f6515db4	69	(int) mapp->phys, (int) mapp->size);
1da177e4 LT	70
	71	mapp->virt = ioremap_nocache(mapp->phys, mapp->size);
	72
	73	if (mapp->virt == 0) {
	74	printk("uclinux[mtd]: ioremap_nocache() failed\n");
	75	return(-EIO);
	76	}
	77
	78	simple_map_init(mapp);
	79
	80	mtd = do_map_probe("map_ram", mapp);
	81	if (!mtd) {
	82	printk("uclinux[mtd]: failed to find a mapping?\n");
	83	iounmap(mapp->virt);
	84	return(-ENXIO);
	85	}
69f34c98	86
1da177e4 LT	87	mtd->owner = THIS_MODULE;
	88	mtd->point = uclinux_point;
	89	mtd->priv = mapp;
	90
	91	uclinux_ram_mtdinfo = mtd;
3ff230a7	92	#ifdef CONFIG_MTD_PARTITIONS
1da177e4	93	add_mtd_partitions(mtd, uclinux_romfs, NUM_PARTITIONS);
3ff230a7 TB	94	#else
	95	add_mtd_device(mtd);
	96	#endif
1da177e4	97
1da177e4 LT	98	return(0);
	99	}
	100
	101	/****************************************************************************/
	102
769455e2	103	static void __exit uclinux_mtd_cleanup(void)
1da177e4 LT	104	{
1da177e4 LT	105	if (uclinux_ram_mtdinfo) {
3ff230a7	106	#ifdef CONFIG_MTD_PARTITIONS
1da177e4	107	del_mtd_partitions(uclinux_ram_mtdinfo);
3ff230a7 TB	108	#else
	109	del_mtd_device(uclinux_ram_mtdinfo);
	110	#endif
1da177e4 LT	111	map_destroy(uclinux_ram_mtdinfo);
	112	uclinux_ram_mtdinfo = NULL;
	113	}
f6515db4	114	if (uclinux_ram_map.virt) {
1da177e4 LT	115	iounmap((void *) uclinux_ram_map.virt);
	116	uclinux_ram_map.virt = 0;
	117	}
	118	}
	119
	120	/****************************************************************************/
	121
	122	module_init(uclinux_mtd_init);
	123	module_exit(uclinux_mtd_cleanup);
	124
	125	MODULE_LICENSE("GPL");
	126	MODULE_AUTHOR("Greg Ungerer <gerg@snapgear.com>");
	127	MODULE_DESCRIPTION("Generic RAM based MTD for uClinux");
	128
	129	/****************************************************************************/