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

/*
 * Mapping of a custom board with both AMD CFI and JEDEC flash in partitions.
 * Config with both CFI and JEDEC device support.
 *
 * Basically physmap.c with the addition of partitions and
 * an array of mapping info to accomodate more than one flash type per board.
 *
 * Copyright 2005-2007 PMC-Sierra, Inc.
 *
 *  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  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
 *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
 *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
 *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
 *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
 *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
 *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
 *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 *  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.,
 *  675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/slab.h>
#include <linux/module.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/mtd/mtd.h>
#include <linux/mtd/map.h>
#include <linux/mtd/partitions.h>

#include <asm/io.h>

#include <msp_prom.h>
#include <msp_regs.h>


static struct mtd_info **msp_flash;
static struct mtd_partition **msp_parts;
static struct map_info *msp_maps;
static int fcnt;

#define DEBUG_MARKER printk(KERN_NOTICE "%s[%d]\n", __func__, __LINE__)

static int __init init_msp_flash(void)
{
	int i, j, ret = -ENOMEM;
	int offset, coff;
	char *env;
	int pcnt;
	char flash_name[] = "flash0";
	char part_name[] = "flash0_0";
	unsigned addr, size;

	/* If ELB is disabled by "ful-mux" mode, we can't get at flash */
	if ((*DEV_ID_REG & DEV_ID_SINGLE_PC) &&
	    (*ELB_1PC_EN_REG & SINGLE_PCCARD)) {
		printk(KERN_NOTICE "Single PC Card mode: no flash access\n");
		return -ENXIO;
	}

	/* examine the prom environment for flash devices */
	for (fcnt = 0; (env = prom_getenv(flash_name)); fcnt++)
		flash_name[5] = '0' + fcnt + 1;

	if (fcnt < 1)
		return -ENXIO;

	printk(KERN_NOTICE "Found %d PMC flash devices\n", fcnt);

	msp_flash = kmalloc(fcnt * sizeof(struct map_info *), GFP_KERNEL);
	if (!msp_flash)
		return -ENOMEM;

	msp_parts = kmalloc(fcnt * sizeof(struct mtd_partition *), GFP_KERNEL);
	if (!msp_parts)
		goto free_msp_flash;

	msp_maps = kcalloc(fcnt, sizeof(struct mtd_info), GFP_KERNEL);
	if (!msp_maps)
		goto free_msp_parts;

	/* loop over the flash devices, initializing each */
	for (i = 0; i < fcnt; i++) {
		/* examine the prom environment for flash partititions */
		part_name[5] = '0' + i;
		part_name[7] = '0';
		for (pcnt = 0; (env = prom_getenv(part_name)); pcnt++)
			part_name[7] = '0' + pcnt + 1;

		if (pcnt == 0) {
			printk(KERN_NOTICE "Skipping flash device %d "
				"(no partitions defined)\n", i);
			continue;
		}

		msp_parts[i] = kcalloc(pcnt, sizeof(struct mtd_partition),
				       GFP_KERNEL);
		if (!msp_parts[i])
			goto cleanup_loop;

		/* now initialize the devices proper */
		flash_name[5] = '0' + i;
		env = prom_getenv(flash_name);

		if (sscanf(env, "%x:%x", &addr, &size) < 2) {
			ret = -ENXIO;
			kfree(msp_parts[i]);
			goto cleanup_loop;
		}
		addr = CPHYSADDR(addr);

		printk(KERN_NOTICE
			"MSP flash device \"%s\": 0x%08x at 0x%08x\n",
			flash_name, size, addr);
		/* This must matchs the actual size of the flash chip */
		msp_maps[i].size = size;
		msp_maps[i].phys = addr;

		/*
		 * Platforms have a specific limit of the size of memory
		 * which may be mapped for flash:
		 */
		if (size > CONFIG_MSP_FLASH_MAP_LIMIT)
			size = CONFIG_MSP_FLASH_MAP_LIMIT;

		msp_maps[i].virt = ioremap(addr, size);
		if (msp_maps[i].virt == NULL) {
			ret = -ENXIO;
			kfree(msp_parts[i]);
			goto cleanup_loop;
		}

		msp_maps[i].bankwidth = 1;
		msp_maps[i].name = kmalloc(7, GFP_KERNEL);
		if (!msp_maps[i].name) {
			iounmap(msp_maps[i].virt);
			kfree(msp_parts[i]);
			goto cleanup_loop;
		}

		msp_maps[i].name = strncpy(msp_maps[i].name, flash_name, 7);

		for (j = 0; j < pcnt; j++) {
			part_name[5] = '0' + i;
			part_name[7] = '0' + j;

			env = prom_getenv(part_name);

			if (sscanf(env, "%x:%x:%n", &offset, &size,
						&coff) < 2) {
				ret = -ENXIO;
				kfree(msp_maps[i].name);
				iounmap(msp_maps[i].virt);
				kfree(msp_parts[i]);
				goto cleanup_loop;
			}

			msp_parts[i][j].size = size;
			msp_parts[i][j].offset = offset;
			msp_parts[i][j].name = env + coff;
		}

		/* now probe and add the device */
		simple_map_init(&msp_maps[i]);
		msp_flash[i] = do_map_probe("cfi_probe", &msp_maps[i]);
		if (msp_flash[i]) {
			msp_flash[i]->owner = THIS_MODULE;
			add_mtd_partitions(msp_flash[i], msp_parts[i], pcnt);
		} else {
			printk(KERN_ERR "map probe failed for flash\n");
			ret = -ENXIO;
			kfree(msp_maps[i].name);
			iounmap(msp_maps[i].virt);
			kfree(msp_parts[i]);
			goto cleanup_loop;
		}
	}

	return 0;

cleanup_loop:
	while (i--) {
		del_mtd_partitions(msp_flash[i]);
		map_destroy(msp_flash[i]);
		kfree(msp_maps[i].name);
		iounmap(msp_maps[i].virt);
		kfree(msp_parts[i]);
	}
	kfree(msp_maps);
free_msp_parts:
	kfree(msp_parts);
free_msp_flash:
	kfree(msp_flash);
	return ret;
}

static void __exit cleanup_msp_flash(void)
{
	int i;

	for (i = 0; i < fcnt; i++) {
		del_mtd_partitions(msp_flash[i]);
		map_destroy(msp_flash[i]);
		iounmap((void *)msp_maps[i].virt);

		/* free the memory */
		kfree(msp_maps[i].name);
		kfree(msp_parts[i]);
	}

	kfree(msp_flash);
	kfree(msp_parts);
	kfree(msp_maps);
}

MODULE_AUTHOR("PMC-Sierra, Inc");
MODULE_DESCRIPTION("MTD map driver for PMC-Sierra MSP boards");
MODULE_LICENSE("GPL");

module_init(init_msp_flash);
module_exit(cleanup_msp_flash);
Commit	Line	Data
68aa0fa8 MSJ	1	/*
	2	* Mapping of a custom board with both AMD CFI and JEDEC flash in partitions.
	3	* Config with both CFI and JEDEC device support.
	4	*
	5	* Basically physmap.c with the addition of partitions and
	6	* an array of mapping info to accomodate more than one flash type per board.
	7	*
	8	* Copyright 2005-2007 PMC-Sierra, Inc.
	9	*
	10	* This program is free software; you can redistribute it and/or modify it
	11	* under the terms of the GNU General Public License as published by the
	12	* Free Software Foundation; either version 2 of the License, or (at your
	13	* option) any later version.
	14	*
	15	* THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
	16	* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
	17	* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
	18	* NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
	19	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
	20	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
	21	* USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
	22	* ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
	23	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
	24	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
	25	*
	26	* You should have received a copy of the GNU General Public License along
	27	* with this program; if not, write to the Free Software Foundation, Inc.,
	28	* 675 Mass Ave, Cambridge, MA 02139, USA.
	29	*/
	30
5a0e3ad6	31	#include <linux/slab.h>
68aa0fa8 MSJ	32	#include <linux/module.h>
	33	#include <linux/types.h>
	34	#include <linux/kernel.h>
	35	#include <linux/mtd/mtd.h>
	36	#include <linux/mtd/map.h>
	37	#include <linux/mtd/partitions.h>
	38
	39	#include <asm/io.h>
	40
	41	#include <msp_prom.h>
	42	#include <msp_regs.h>
	43
	44
	45	static struct mtd_info **msp_flash;
	46	static struct mtd_partition **msp_parts;
	47	static struct map_info *msp_maps;
	48	static int fcnt;
	49
cb53b3b9	50	#define DEBUG_MARKER printk(KERN_NOTICE "%s[%d]\n", __func__, __LINE__)
68aa0fa8	51
6127cfcd	52	static int __init init_msp_flash(void)
68aa0fa8	53	{
2c78c443	54	int i, j, ret = -ENOMEM;
68aa0fa8 MSJ	55	int offset, coff;
	56	char *env;
	57	int pcnt;
	58	char flash_name[] = "flash0";
	59	char part_name[] = "flash0_0";
	60	unsigned addr, size;
	61
	62	/* If ELB is disabled by "ful-mux" mode, we can't get at flash */
	63	if ((*DEV_ID_REG & DEV_ID_SINGLE_PC) &&
	64	(*ELB_1PC_EN_REG & SINGLE_PCCARD)) {
	65	printk(KERN_NOTICE "Single PC Card mode: no flash access\n");
	66	return -ENXIO;
	67	}
	68
	69	/* examine the prom environment for flash devices */
	70	for (fcnt = 0; (env = prom_getenv(flash_name)); fcnt++)
	71	flash_name[5] = '0' + fcnt + 1;
	72
	73	if (fcnt < 1)
	74	return -ENXIO;
	75
	76	printk(KERN_NOTICE "Found %d PMC flash devices\n", fcnt);
4fb4caa6 MK	77
4fb4caa6 MK	78	msp_flash = kmalloc(fcnt * sizeof(struct map_info *), GFP_KERNEL);
2c78c443 RK	79	if (!msp_flash)
	80	return -ENOMEM;
	81
4fb4caa6	82	msp_parts = kmalloc(fcnt * sizeof(struct mtd_partition *), GFP_KERNEL);
2c78c443 RK	83	if (!msp_parts)
	84	goto free_msp_flash;
	85
4fb4caa6	86	msp_maps = kcalloc(fcnt, sizeof(struct mtd_info), GFP_KERNEL);
2c78c443 RK	87	if (!msp_maps)
2c78c443 RK	88	goto free_msp_parts;
68aa0fa8 MSJ	89
	90	/* loop over the flash devices, initializing each */
	91	for (i = 0; i < fcnt; i++) {
	92	/* examine the prom environment for flash partititions */
	93	part_name[5] = '0' + i;
	94	part_name[7] = '0';
	95	for (pcnt = 0; (env = prom_getenv(part_name)); pcnt++)
	96	part_name[7] = '0' + pcnt + 1;
	97
	98	if (pcnt == 0) {
	99	printk(KERN_NOTICE "Skipping flash device %d "
	100	"(no partitions defined)\n", i);
	101	continue;
	102	}
	103
4fb4caa6 MK	104	msp_parts[i] = kcalloc(pcnt, sizeof(struct mtd_partition),
4fb4caa6 MK	105	GFP_KERNEL);
2c78c443 RK	106	if (!msp_parts[i])
2c78c443 RK	107	goto cleanup_loop;
68aa0fa8 MSJ	108
	109	/* now initialize the devices proper */
	110	flash_name[5] = '0' + i;
	111	env = prom_getenv(flash_name);
	112
2c78c443 RK	113	if (sscanf(env, "%x:%x", &addr, &size) < 2) {
	114	ret = -ENXIO;
	115	kfree(msp_parts[i]);
	116	goto cleanup_loop;
	117	}
68aa0fa8 MSJ	118	addr = CPHYSADDR(addr);
	119
	120	printk(KERN_NOTICE
	121	"MSP flash device \"%s\": 0x%08x at 0x%08x\n",
	122	flash_name, size, addr);
	123	/* This must matchs the actual size of the flash chip */
	124	msp_maps[i].size = size;
	125	msp_maps[i].phys = addr;
	126
	127	/*
	128	* Platforms have a specific limit of the size of memory
	129	* which may be mapped for flash:
	130	*/
	131	if (size > CONFIG_MSP_FLASH_MAP_LIMIT)
	132	size = CONFIG_MSP_FLASH_MAP_LIMIT;
2c78c443	133
68aa0fa8	134	msp_maps[i].virt = ioremap(addr, size);
2c78c443 RK	135	if (msp_maps[i].virt == NULL) {
	136	ret = -ENXIO;
	137	kfree(msp_parts[i]);
	138	goto cleanup_loop;
	139	}
	140
68aa0fa8	141	msp_maps[i].bankwidth = 1;
2c78c443 RK	142	msp_maps[i].name = kmalloc(7, GFP_KERNEL);
	143	if (!msp_maps[i].name) {
	144	iounmap(msp_maps[i].virt);
	145	kfree(msp_parts[i]);
	146	goto cleanup_loop;
	147	}
68aa0fa8	148
2c78c443	149	msp_maps[i].name = strncpy(msp_maps[i].name, flash_name, 7);
68aa0fa8 MSJ	150
	151	for (j = 0; j < pcnt; j++) {
	152	part_name[5] = '0' + i;
	153	part_name[7] = '0' + j;
	154
	155	env = prom_getenv(part_name);
	156
2c78c443 RK	157	if (sscanf(env, "%x:%x:%n", &offset, &size,
	158	&coff) < 2) {
	159	ret = -ENXIO;
	160	kfree(msp_maps[i].name);
	161	iounmap(msp_maps[i].virt);
	162	kfree(msp_parts[i]);
	163	goto cleanup_loop;
	164	}
68aa0fa8 MSJ	165
	166	msp_parts[i][j].size = size;
	167	msp_parts[i][j].offset = offset;
	168	msp_parts[i][j].name = env + coff;
	169	}
	170
	171	/* now probe and add the device */
	172	simple_map_init(&msp_maps[i]);
	173	msp_flash[i] = do_map_probe("cfi_probe", &msp_maps[i]);
	174	if (msp_flash[i]) {
	175	msp_flash[i]->owner = THIS_MODULE;
	176	add_mtd_partitions(msp_flash[i], msp_parts[i], pcnt);
	177	} else {
	178	printk(KERN_ERR "map probe failed for flash\n");
2c78c443 RK	179	ret = -ENXIO;
	180	kfree(msp_maps[i].name);
	181	iounmap(msp_maps[i].virt);
	182	kfree(msp_parts[i]);
	183	goto cleanup_loop;
68aa0fa8 MSJ	184	}
	185	}
	186
	187	return 0;
2c78c443 RK	188
	189	cleanup_loop:
	190	while (i--) {
	191	del_mtd_partitions(msp_flash[i]);
	192	map_destroy(msp_flash[i]);
	193	kfree(msp_maps[i].name);
	194	iounmap(msp_maps[i].virt);
	195	kfree(msp_parts[i]);
	196	}
	197	kfree(msp_maps);
	198	free_msp_parts:
	199	kfree(msp_parts);
	200	free_msp_flash:
	201	kfree(msp_flash);
	202	return ret;
68aa0fa8 MSJ	203	}
	204
	205	static void __exit cleanup_msp_flash(void)
	206	{
	207	int i;
	208
2c78c443	209	for (i = 0; i < fcnt; i++) {
68aa0fa8 MSJ	210	del_mtd_partitions(msp_flash[i]);
	211	map_destroy(msp_flash[i]);
	212	iounmap((void *)msp_maps[i].virt);
	213
	214	/* free the memory */
	215	kfree(msp_maps[i].name);
	216	kfree(msp_parts[i]);
	217	}
	218
	219	kfree(msp_flash);
	220	kfree(msp_parts);
	221	kfree(msp_maps);
	222	}
	223
	224	MODULE_AUTHOR("PMC-Sierra, Inc");
	225	MODULE_DESCRIPTION("MTD map driver for PMC-Sierra MSP boards");
	226	MODULE_LICENSE("GPL");
	227
	228	module_init(init_msp_flash);
	229	module_exit(cleanup_msp_flash);