[deliverable/linux.git] / drivers / mtd / maps / scx200_docflash.c

/* linux/drivers/mtd/maps/scx200_docflash.c

   Copyright (c) 2001,2002 Christer Weinigel <wingel@nano-system.com>

   National Semiconductor SCx200 flash mapped with DOCCS
*/

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

#include <linux/pci.h>
#include <linux/scx200.h>

#define NAME "scx200_docflash"

MODULE_AUTHOR("Christer Weinigel <wingel@hack.org>");
MODULE_DESCRIPTION("NatSemi SCx200 DOCCS Flash Driver");
MODULE_LICENSE("GPL");

static int probe = 0;		/* Don't autoprobe */
static unsigned size = 0x1000000; /* 16 MiB the whole ISA address space */
static unsigned width = 8;	/* Default to 8 bits wide */
static char *flashtype = "cfi_probe";

module_param(probe, int, 0);
MODULE_PARM_DESC(probe, "Probe for a BIOS mapping");
module_param(size, int, 0);
MODULE_PARM_DESC(size, "Size of the flash mapping");
module_param(width, int, 0);
MODULE_PARM_DESC(width, "Data width of the flash mapping (8/16)");
module_param(flashtype, charp, 0);
MODULE_PARM_DESC(flashtype, "Type of MTD probe to do");

static struct resource docmem = {
	.flags = IORESOURCE_MEM,
	.name  = "NatSemi SCx200 DOCCS Flash",
};

static struct mtd_info *mymtd;

#ifdef CONFIG_MTD_PARTITIONS
static struct mtd_partition partition_info[] = {
	{
		.name   = "DOCCS Boot kernel",
		.offset = 0,
		.size   = 0xc0000
	},
	{
		.name   = "DOCCS Low BIOS",
		.offset = 0xc0000,
		.size   = 0x40000
	},
	{
		.name   = "DOCCS File system",
		.offset = 0x100000,
		.size   = ~0	/* calculate from flash size */
	},
	{
		.name   = "DOCCS High BIOS",
		.offset = ~0, 	/* calculate from flash size */
		.size   = 0x80000
	},
};
#define NUM_PARTITIONS ARRAY_SIZE(partition_info)
#endif


static struct map_info scx200_docflash_map = {
	.name      = "NatSemi SCx200 DOCCS Flash",
};

static int __init init_scx200_docflash(void)
{
	unsigned u;
	unsigned base;
	unsigned ctrl;
	unsigned pmr;
	struct pci_dev *bridge;

	printk(KERN_DEBUG NAME ": NatSemi SCx200 DOCCS Flash Driver\n");

	if ((bridge = pci_get_device(PCI_VENDOR_ID_NS,
				      PCI_DEVICE_ID_NS_SCx200_BRIDGE,
				      NULL)) == NULL)
		return -ENODEV;

	/* check that we have found the configuration block */
	if (!scx200_cb_present()) {
		pci_dev_put(bridge);
		return -ENODEV;
	}

	if (probe) {
		/* Try to use the present flash mapping if any */
		pci_read_config_dword(bridge, SCx200_DOCCS_BASE, &base);
		pci_read_config_dword(bridge, SCx200_DOCCS_CTRL, &ctrl);
		pci_dev_put(bridge);

		pmr = inl(scx200_cb_base + SCx200_PMR);

		if (base == 0
		    || (ctrl & 0x07000000) != 0x07000000
		    || (ctrl & 0x0007ffff) == 0)
			return -ENODEV;

		size = ((ctrl&0x1fff)<<13) + (1<<13);

		for (u = size; u > 1; u >>= 1)
			;
		if (u != 1)
			return -ENODEV;

		if (pmr & (1<<6))
			width = 16;
		else
			width = 8;

		docmem.start = base;
		docmem.end = base + size;

		if (request_resource(&iomem_resource, &docmem)) {
			printk(KERN_ERR NAME ": unable to allocate memory for flash mapping\n");
			return -ENOMEM;
		}
	} else {
		pci_dev_put(bridge);
		for (u = size; u > 1; u >>= 1)
			;
		if (u != 1) {
			printk(KERN_ERR NAME ": invalid size for flash mapping\n");
			return -EINVAL;
		}

		if (width != 8 && width != 16) {
			printk(KERN_ERR NAME ": invalid bus width for flash mapping\n");
			return -EINVAL;
		}

		if (allocate_resource(&iomem_resource, &docmem,
				      size,
				      0xc0000000, 0xffffffff,
				      size, NULL, NULL)) {
			printk(KERN_ERR NAME ": unable to allocate memory for flash mapping\n");
			return -ENOMEM;
		}

		ctrl = 0x07000000 | ((size-1) >> 13);

		printk(KERN_INFO "DOCCS BASE=0x%08lx, CTRL=0x%08lx\n", (long)docmem.start, (long)ctrl);

		pci_write_config_dword(bridge, SCx200_DOCCS_BASE, docmem.start);
		pci_write_config_dword(bridge, SCx200_DOCCS_CTRL, ctrl);
		pmr = inl(scx200_cb_base + SCx200_PMR);

		if (width == 8) {
			pmr &= ~(1<<6);
		} else {
			pmr |= (1<<6);
		}
		outl(pmr, scx200_cb_base + SCx200_PMR);
	}

       	printk(KERN_INFO NAME ": DOCCS mapped at 0x%llx-0x%llx, width %d\n",
			(unsigned long long)docmem.start,
			(unsigned long long)docmem.end, width);

	scx200_docflash_map.size = size;
	if (width == 8)
		scx200_docflash_map.bankwidth = 1;
	else
		scx200_docflash_map.bankwidth = 2;

	simple_map_init(&scx200_docflash_map);

	scx200_docflash_map.phys = docmem.start;
	scx200_docflash_map.virt = ioremap(docmem.start, scx200_docflash_map.size);
	if (!scx200_docflash_map.virt) {
		printk(KERN_ERR NAME ": failed to ioremap the flash\n");
		release_resource(&docmem);
		return -EIO;
	}

	mymtd = do_map_probe(flashtype, &scx200_docflash_map);
	if (!mymtd) {
		printk(KERN_ERR NAME ": unable to detect flash\n");
		iounmap(scx200_docflash_map.virt);
		release_resource(&docmem);
		return -ENXIO;
	}

	if (size < mymtd->size)
		printk(KERN_WARNING NAME ": warning, flash mapping is smaller than flash size\n");

	mymtd->owner = THIS_MODULE;

#ifdef CONFIG_MTD_PARTITIONS
	partition_info[3].offset = mymtd->size-partition_info[3].size;
	partition_info[2].size = partition_info[3].offset-partition_info[2].offset;
	add_mtd_partitions(mymtd, partition_info, NUM_PARTITIONS);
#else
	add_mtd_device(mymtd);
#endif
	return 0;
}

static void __exit cleanup_scx200_docflash(void)
{
	if (mymtd) {
#ifdef CONFIG_MTD_PARTITIONS
		del_mtd_partitions(mymtd);
#else
		del_mtd_device(mymtd);
#endif
		map_destroy(mymtd);
	}
	if (scx200_docflash_map.virt) {
		iounmap(scx200_docflash_map.virt);
		release_resource(&docmem);
	}
}

module_init(init_scx200_docflash);
module_exit(cleanup_scx200_docflash);

/*
    Local variables:
        compile-command: "make -k -C ../../.. SUBDIRS=drivers/mtd/maps modules"
        c-basic-offset: 8
    End:
*/
Commit	Line	Data
69f34c98	1	/* linux/drivers/mtd/maps/scx200_docflash.c
1da177e4 LT	2
	3	Copyright (c) 2001,2002 Christer Weinigel <wingel@nano-system.com>
	4
1da177e4 LT	5	National Semiconductor SCx200 flash mapped with DOCCS
	6	*/
	7
	8	#include <linux/module.h>
1da177e4 LT	9	#include <linux/types.h>
	10	#include <linux/kernel.h>
	11	#include <linux/init.h>
	12	#include <asm/io.h>
	13	#include <linux/mtd/mtd.h>
	14	#include <linux/mtd/map.h>
	15	#include <linux/mtd/partitions.h>
	16
	17	#include <linux/pci.h>
	18	#include <linux/scx200.h>
	19
	20	#define NAME "scx200_docflash"
	21
	22	MODULE_AUTHOR("Christer Weinigel <wingel@hack.org>");
	23	MODULE_DESCRIPTION("NatSemi SCx200 DOCCS Flash Driver");
	24	MODULE_LICENSE("GPL");
	25
	26	static int probe = 0; /* Don't autoprobe */
	27	static unsigned size = 0x1000000; /* 16 MiB the whole ISA address space */
	28	static unsigned width = 8; /* Default to 8 bits wide */
	29	static char *flashtype = "cfi_probe";
	30
	31	module_param(probe, int, 0);
	32	MODULE_PARM_DESC(probe, "Probe for a BIOS mapping");
	33	module_param(size, int, 0);
	34	MODULE_PARM_DESC(size, "Size of the flash mapping");
	35	module_param(width, int, 0);
	36	MODULE_PARM_DESC(width, "Data width of the flash mapping (8/16)");
	37	module_param(flashtype, charp, 0);
	38	MODULE_PARM_DESC(flashtype, "Type of MTD probe to do");
	39
	40	static struct resource docmem = {
	41	.flags = IORESOURCE_MEM,
	42	.name = "NatSemi SCx200 DOCCS Flash",
	43	};
	44
	45	static struct mtd_info *mymtd;
	46
	47	#ifdef CONFIG_MTD_PARTITIONS
	48	static struct mtd_partition partition_info[] = {
69f34c98 TG	49	{
	50	.name = "DOCCS Boot kernel",
	51	.offset = 0,
1da177e4 LT	52	.size = 0xc0000
1da177e4 LT	53	},
69f34c98 TG	54	{
	55	.name = "DOCCS Low BIOS",
	56	.offset = 0xc0000,
1da177e4 LT	57	.size = 0x40000
1da177e4 LT	58	},
69f34c98 TG	59	{
	60	.name = "DOCCS File system",
	61	.offset = 0x100000,
1da177e4 LT	62	.size = ~0 /* calculate from flash size */
1da177e4 LT	63	},
69f34c98 TG	64	{
69f34c98 TG	65	.name = "DOCCS High BIOS",
1da177e4 LT	66	.offset = ~0, /* calculate from flash size */
	67	.size = 0x80000
	68	},
	69	};
87d10f3c	70	#define NUM_PARTITIONS ARRAY_SIZE(partition_info)
1da177e4 LT	71	#endif
	72
	73
	74	static struct map_info scx200_docflash_map = {
	75	.name = "NatSemi SCx200 DOCCS Flash",
	76	};
	77
	78	static int __init init_scx200_docflash(void)
	79	{
	80	unsigned u;
	81	unsigned base;
	82	unsigned ctrl;
	83	unsigned pmr;
	84	struct pci_dev *bridge;
	85
	86	printk(KERN_DEBUG NAME ": NatSemi SCx200 DOCCS Flash Driver\n");
	87
dd8e9ed6	88	if ((bridge = pci_get_device(PCI_VENDOR_ID_NS,
1da177e4 LT	89	PCI_DEVICE_ID_NS_SCx200_BRIDGE,
	90	NULL)) == NULL)
	91	return -ENODEV;
	92
	93	/* check that we have found the configuration block */
dd8e9ed6 AC	94	if (!scx200_cb_present()) {
dd8e9ed6 AC	95	pci_dev_put(bridge);
1da177e4	96	return -ENODEV;
dd8e9ed6	97	}
1da177e4 LT	98
	99	if (probe) {
	100	/* Try to use the present flash mapping if any */
	101	pci_read_config_dword(bridge, SCx200_DOCCS_BASE, &base);
	102	pci_read_config_dword(bridge, SCx200_DOCCS_CTRL, &ctrl);
dd8e9ed6 AC	103	pci_dev_put(bridge);
dd8e9ed6 AC	104
1da177e4 LT	105	pmr = inl(scx200_cb_base + SCx200_PMR);
	106
	107	if (base == 0
	108	\|\| (ctrl & 0x07000000) != 0x07000000
	109	\|\| (ctrl & 0x0007ffff) == 0)
	110	return -ENODEV;
	111
	112	size = ((ctrl&0x1fff)<<13) + (1<<13);
	113
	114	for (u = size; u > 1; u >>= 1)
	115	;
	116	if (u != 1)
	117	return -ENODEV;
	118
	119	if (pmr & (1<<6))
	120	width = 16;
	121	else
	122	width = 8;
	123
	124	docmem.start = base;
	125	docmem.end = base + size;
	126
	127	if (request_resource(&iomem_resource, &docmem)) {
	128	printk(KERN_ERR NAME ": unable to allocate memory for flash mapping\n");
	129	return -ENOMEM;
	130	}
	131	} else {
dd8e9ed6	132	pci_dev_put(bridge);
1da177e4 LT	133	for (u = size; u > 1; u >>= 1)
	134	;
	135	if (u != 1) {
	136	printk(KERN_ERR NAME ": invalid size for flash mapping\n");
	137	return -EINVAL;
	138	}
69f34c98	139
1da177e4 LT	140	if (width != 8 && width != 16) {
	141	printk(KERN_ERR NAME ": invalid bus width for flash mapping\n");
	142	return -EINVAL;
	143	}
69f34c98 TG	144
69f34c98 TG	145	if (allocate_resource(&iomem_resource, &docmem,
1da177e4	146	size,
69f34c98	147	0xc0000000, 0xffffffff,
1da177e4 LT	148	size, NULL, NULL)) {
	149	printk(KERN_ERR NAME ": unable to allocate memory for flash mapping\n");
	150	return -ENOMEM;
	151	}
69f34c98	152
1da177e4 LT	153	ctrl = 0x07000000 \| ((size-1) >> 13);
	154
	155	printk(KERN_INFO "DOCCS BASE=0x%08lx, CTRL=0x%08lx\n", (long)docmem.start, (long)ctrl);
69f34c98	156
1da177e4 LT	157	pci_write_config_dword(bridge, SCx200_DOCCS_BASE, docmem.start);
	158	pci_write_config_dword(bridge, SCx200_DOCCS_CTRL, ctrl);
	159	pmr = inl(scx200_cb_base + SCx200_PMR);
69f34c98	160
1da177e4 LT	161	if (width == 8) {
	162	pmr &= ~(1<<6);
	163	} else {
	164	pmr \|= (1<<6);
	165	}
	166	outl(pmr, scx200_cb_base + SCx200_PMR);
	167	}
69f34c98	168
176dfc63 GKH	169	printk(KERN_INFO NAME ": DOCCS mapped at 0x%llx-0x%llx, width %d\n",
	170	(unsigned long long)docmem.start,
	171	(unsigned long long)docmem.end, width);
1da177e4 LT	172
	173	scx200_docflash_map.size = size;
	174	if (width == 8)
	175	scx200_docflash_map.bankwidth = 1;
	176	else
	177	scx200_docflash_map.bankwidth = 2;
	178
	179	simple_map_init(&scx200_docflash_map);
	180
	181	scx200_docflash_map.phys = docmem.start;
	182	scx200_docflash_map.virt = ioremap(docmem.start, scx200_docflash_map.size);
	183	if (!scx200_docflash_map.virt) {
	184	printk(KERN_ERR NAME ": failed to ioremap the flash\n");
	185	release_resource(&docmem);
	186	return -EIO;
	187	}
	188
	189	mymtd = do_map_probe(flashtype, &scx200_docflash_map);
	190	if (!mymtd) {
	191	printk(KERN_ERR NAME ": unable to detect flash\n");
	192	iounmap(scx200_docflash_map.virt);
	193	release_resource(&docmem);
	194	return -ENXIO;
	195	}
	196
	197	if (size < mymtd->size)
	198	printk(KERN_WARNING NAME ": warning, flash mapping is smaller than flash size\n");
	199
	200	mymtd->owner = THIS_MODULE;
	201
	202	#ifdef CONFIG_MTD_PARTITIONS
	203	partition_info[3].offset = mymtd->size-partition_info[3].size;
	204	partition_info[2].size = partition_info[3].offset-partition_info[2].offset;
	205	add_mtd_partitions(mymtd, partition_info, NUM_PARTITIONS);
	206	#else
	207	add_mtd_device(mymtd);
	208	#endif
	209	return 0;
	210	}
	211
	212	static void __exit cleanup_scx200_docflash(void)
	213	{
	214	if (mymtd) {
	215	#ifdef CONFIG_MTD_PARTITIONS
	216	del_mtd_partitions(mymtd);
	217	#else
	218	del_mtd_device(mymtd);
	219	#endif
	220	map_destroy(mymtd);
	221	}
	222	if (scx200_docflash_map.virt) {
	223	iounmap(scx200_docflash_map.virt);
	224	release_resource(&docmem);
	225	}
	226	}
	227
	228	module_init(init_scx200_docflash);
	229	module_exit(cleanup_scx200_docflash);
	230
	231	/*
	232	Local variables:
	233	compile-command: "make -k -C ../../.. SUBDIRS=drivers/mtd/maps modules"
	234	c-basic-offset: 8
	235	End:
236	*/