mirror of
				git://git.openwrt.org/openwrt/openwrt.git
				synced 2025-10-31 14:04:26 -04:00 
			
		
		
		
	
		
			
				
	
	
		
			711 lines
		
	
	
		
			18 KiB
		
	
	
	
		
			Diff
		
	
	
	
	
	
			
		
		
	
	
			711 lines
		
	
	
		
			18 KiB
		
	
	
	
		
			Diff
		
	
	
	
	
	
| --- a/drivers/mtd/nand/Kconfig
 | |
| +++ b/drivers/mtd/nand/Kconfig
 | |
| @@ -607,4 +607,12 @@ config MTD_NAND_FSMC
 | |
|  	  Enables support for NAND Flash chips on the ST Microelectronics
 | |
|  	  Flexible Static Memory Controller (FSMC)
 | |
|  
 | |
| +config MTD_NAND_BCM47XX
 | |
| +	tristate "bcm47xx nand flash support"
 | |
| +	default y
 | |
| +	depends on BCM47XX && BCMA_NFLASH
 | |
| +	select MTD_PARTITIONS
 | |
| +	help
 | |
| +	  Support for bcm47xx nand flash
 | |
| +
 | |
|  endif # MTD_NAND
 | |
| --- a/drivers/mtd/nand/Makefile
 | |
| +++ b/drivers/mtd/nand/Makefile
 | |
| @@ -51,5 +51,6 @@ obj-$(CONFIG_MTD_NAND_MPC5121_NFC)	+= mp
 | |
|  obj-$(CONFIG_MTD_NAND_RICOH)		+= r852.o
 | |
|  obj-$(CONFIG_MTD_NAND_JZ4740)		+= jz4740_nand.o
 | |
|  obj-$(CONFIG_MTD_NAND_GPMI_NAND)	+= gpmi-nand/
 | |
| +obj-$(CONFIG_MTD_NAND_BCM47XX)		+= bcm47xx_nand.o
 | |
|  
 | |
|  nand-objs := nand_base.o nand_bbt.o
 | |
| --- /dev/null
 | |
| +++ b/drivers/mtd/nand/bcm47xx_nand.c
 | |
| @@ -0,0 +1,528 @@
 | |
| +/*
 | |
| + * BCMA nand flash interface
 | |
| + *
 | |
| + * Copyright (C) 2011-2012 Tathagata Das <tathagata@alumnux.com>
 | |
| + * Copyright 2010, Broadcom Corporation
 | |
| + *
 | |
| + * THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY
 | |
| + * KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
 | |
| + * SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
 | |
| + * FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
 | |
| + *
 | |
| + */
 | |
| +
 | |
| +#define pr_fmt(fmt) "bcm47xx_nflash: " fmt
 | |
| +#include <linux/module.h>
 | |
| +#include <linux/slab.h>
 | |
| +#include <linux/ioport.h>
 | |
| +#include <linux/sched.h>
 | |
| +#include <linux/mtd/mtd.h>
 | |
| +#include <linux/mtd/map.h>
 | |
| +#include <linux/mtd/partitions.h>
 | |
| +#include <linux/errno.h>
 | |
| +#include <linux/delay.h>
 | |
| +#include <linux/platform_device.h>
 | |
| +#include <bcm47xx.h>
 | |
| +#include <linux/cramfs_fs.h>
 | |
| +#include <linux/romfs_fs.h>
 | |
| +#include <linux/magic.h>
 | |
| +#include <linux/byteorder/generic.h>
 | |
| +#include <linux/mtd/bcm47xx_nand.h>
 | |
| +#include <linux/mtd/nand.h>
 | |
| +
 | |
| +static int bcm47xx_nflash_block_bad(struct mtd_info *mtd, loff_t ofs, int getchip);
 | |
| +static int bcm47xx_nflash_erase(struct mtd_info *mtd, unsigned int addr, unsigned int len);
 | |
| +
 | |
| +/* Private Global variable */
 | |
| +static u32 read_offset = 0;
 | |
| +static u32 write_offset;
 | |
| +
 | |
| +static int
 | |
| +nflash_mtd_poll(struct bcm47xx_nflash *nflash, unsigned int offset, int timeout)
 | |
| +{
 | |
| +	unsigned long now = jiffies;
 | |
| +	int ret = 0;
 | |
| +
 | |
| +	for (;;) {
 | |
| +		if (!bcma_nflash_poll(nflash->bcc)) {
 | |
| +			ret = 0;
 | |
| +			break;
 | |
| +		}
 | |
| +		if (time_after(jiffies, now + timeout)) {
 | |
| +			pr_err("timeout while polling\n");
 | |
| +			ret = -ETIMEDOUT;
 | |
| +			break;
 | |
| +		}
 | |
| +		udelay(1);
 | |
| +	}
 | |
| +
 | |
| +	return ret;
 | |
| +}
 | |
| +
 | |
| +static int
 | |
| +bcm47xx_nflash_read(struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf)
 | |
| +{
 | |
| +	struct nand_chip *nchip = (struct nand_chip *)mtd->priv;
 | |
| +	struct bcm47xx_nflash *nflash = (struct bcm47xx_nflash *)nchip->priv;
 | |
| +	int bytes, ret = 0;
 | |
| +	u32 extra = 0;
 | |
| +	u8 *tmpbuf = NULL;
 | |
| +	int size;
 | |
| +	u32 offset, blocksize, mask, off;
 | |
| +	u32 skip_bytes = 0;
 | |
| +	int need_copy = 0;
 | |
| +	u8 *ptr = NULL;
 | |
| +
 | |
| +	/* Check address range */
 | |
| +	if (!len)
 | |
| +		return 0;
 | |
| +	if ((from + len) > mtd->size)
 | |
| +		return -EINVAL;
 | |
| +	offset = from;
 | |
| +	if ((offset & (NFL_SECTOR_SIZE - 1)) != 0) {
 | |
| +		extra = offset & (NFL_SECTOR_SIZE - 1);
 | |
| +		offset -= extra;
 | |
| +		len += extra;
 | |
| +		need_copy = 1;
 | |
| +	}
 | |
| +	size = (len + (NFL_SECTOR_SIZE - 1)) & ~(NFL_SECTOR_SIZE - 1);
 | |
| +	if (size != len) {
 | |
| +		need_copy = 1;
 | |
| +	}
 | |
| +	if (!need_copy) {
 | |
| +		ptr = buf;
 | |
| +	} else {
 | |
| +		tmpbuf = (u8 *)kmalloc(size, GFP_KERNEL);
 | |
| +		ptr = tmpbuf;
 | |
| +	}
 | |
| +
 | |
| +	blocksize = mtd->erasesize;
 | |
| +	mask = blocksize - 1;
 | |
| +	*retlen = 0;
 | |
| +	while (len > 0) {
 | |
| +		off = offset + skip_bytes;
 | |
| +		if ((bytes = bcma_nflash_read(nflash->bcc, off, NFL_SECTOR_SIZE, ptr)) < 0) {
 | |
| +			ret = bytes;
 | |
| +			goto done;
 | |
| +		}
 | |
| +		if (bytes > len)
 | |
| +			bytes = len;
 | |
| +		offset += bytes;
 | |
| +		len -= bytes;
 | |
| +		ptr += bytes;
 | |
| +		*retlen += bytes;
 | |
| +	}
 | |
| +
 | |
| +done:
 | |
| +	if (tmpbuf) {
 | |
| +		*retlen -= extra;
 | |
| +		memcpy(buf, tmpbuf+extra, *retlen);
 | |
| +		kfree(tmpbuf);
 | |
| +	}
 | |
| +
 | |
| +	return ret;
 | |
| +}
 | |
| +
 | |
| +static void bcm47xx_nflash_write(struct mtd_info *mtd, u32 to, const u_char *buf, u32 len)
 | |
| +{
 | |
| +	struct nand_chip *nchip = (struct nand_chip *)mtd->priv;
 | |
| +	struct bcm47xx_nflash *nflash = (struct bcm47xx_nflash *)nchip->priv;
 | |
| +	u32 offset, blocksize, mask, off;
 | |
| +	int read_len;
 | |
| +	u32 copy_len, write_len, from;
 | |
| +	u_char *write_ptr, *block;
 | |
| +	const u_char *ptr;
 | |
| +	int ret, bytes;
 | |
| +
 | |
| +	/* Check address range */
 | |
| +	if (!len) {
 | |
| +		pr_err("Error: Attempted to write too small data\n");
 | |
| +		return;
 | |
| +	}
 | |
| +
 | |
| +	if (!to)
 | |
| +		return;
 | |
| +
 | |
| +	if ((to + len) > mtd->size) {
 | |
| +		pr_err("Error: Attempted to write too large data\n");
 | |
| +		return;
 | |
| +	}
 | |
| +
 | |
| +	ptr = buf;
 | |
| +	block = NULL;
 | |
| +	offset = to;
 | |
| +	blocksize = mtd->erasesize;
 | |
| +	if (!(block = kmalloc(blocksize, GFP_KERNEL)))
 | |
| +		return;
 | |
| +	mask = blocksize - 1;
 | |
| +	while (len) {
 | |
| +		/* Align offset */
 | |
| +		from = offset & ~mask;
 | |
| +		/* Copy existing data into holding block if necessary */
 | |
| +		if (((offset & (blocksize-1)) != 0) || (len < blocksize)) {
 | |
| +			if ((ret = bcm47xx_nflash_read(mtd, from, blocksize, &read_len, block)))
 | |
| +				goto done;
 | |
| +			if (read_len != blocksize) {
 | |
| +				ret = -EINVAL;
 | |
| +				goto done;
 | |
| +			}
 | |
| +		}
 | |
| +
 | |
| +		/* Copy input data into holding block */
 | |
| +		copy_len = min(len, blocksize - (offset & mask));
 | |
| +		memcpy(block + (offset & mask), ptr, copy_len);
 | |
| +		off = (uint) from;
 | |
| +		/* Erase block */
 | |
| +		if ((ret = bcm47xx_nflash_erase(mtd, off, blocksize)) < 0)
 | |
| +			goto done;
 | |
| +		/* Write holding block */
 | |
| +		write_ptr = block;
 | |
| +		write_len = blocksize;
 | |
| +		if ((bytes = bcma_nflash_write(nflash->bcc, (uint)from, (uint)write_len, (u8 *) write_ptr)) != 0) {
 | |
| +			ret = bytes;
 | |
| +			goto done;
 | |
| +		}
 | |
| +		offset += copy_len;
 | |
| +		if (len < copy_len)
 | |
| +			len = 0;
 | |
| +		else
 | |
| +			len -= copy_len;
 | |
| +		ptr += copy_len;
 | |
| +	}
 | |
| +
 | |
| +done:
 | |
| +	if (block)
 | |
| +		kfree(block);
 | |
| +	return;
 | |
| +}
 | |
| +
 | |
| +static int bcm47xx_nflash_erase(struct mtd_info *mtd, unsigned int addr, unsigned int len)
 | |
| +{
 | |
| +	struct nand_chip *nchip = (struct nand_chip *)mtd->priv;
 | |
| +	struct bcm47xx_nflash *nflash = (struct bcm47xx_nflash *)nchip->priv;
 | |
| +
 | |
| +	/* Check address range */
 | |
| +	if (!len)
 | |
| +		return 1;
 | |
| +	if ((addr + len) > mtd->size)
 | |
| +		return 1;
 | |
| +
 | |
| +	if (bcma_nflash_erase(nflash->bcc, addr)) {
 | |
| +		pr_err("ERASE: nflash erase error\n");
 | |
| +		return 1;
 | |
| +	}
 | |
| +
 | |
| +	if (nflash_mtd_poll(nflash, addr, 10 * HZ)) {
 | |
| +		pr_err("ERASE: nflash_mtd_poll error\n");
 | |
| +		return 1;
 | |
| +	}
 | |
| +
 | |
| +	return 0;
 | |
| +}
 | |
| +
 | |
| +/* This functions is used by upper layer to checks if device is ready */
 | |
| +static int bcm47xx_nflash_dev_ready(struct mtd_info *mtd)
 | |
| +{
 | |
| +	return 1;
 | |
| +}
 | |
| +
 | |
| +/* Issue a nand flash command */
 | |
| +static inline void bcm47xx_nflash_cmd(struct bcma_drv_cc *cc, u32 opcode)
 | |
| +{
 | |
| +	bcma_cc_write32(cc, NAND_CMD_START, opcode);
 | |
| +	bcma_cc_read32(cc,  NAND_CMD_START);
 | |
| +}
 | |
| +
 | |
| +static void bcm47xx_nflash_command(struct mtd_info *mtd, unsigned command,
 | |
| +				int column, int page_addr)
 | |
| +{
 | |
| +	struct nand_chip *nchip = (struct nand_chip *)mtd->priv;
 | |
| +	struct bcm47xx_nflash *nflash = (struct bcm47xx_nflash *)nchip->priv;
 | |
| +	u32 pagesize = 1 << nchip->page_shift;
 | |
| +
 | |
| +	/* Command pre-processing step */
 | |
| +	switch (command) {
 | |
| +	case NAND_CMD_RESET:
 | |
| +		bcm47xx_nflash_cmd(nflash->bcc, NCMD_FLASH_RESET);
 | |
| +		break;
 | |
| +
 | |
| +	case NAND_CMD_STATUS:
 | |
| +		nflash->next_opcode = NAND_CMD_STATUS;
 | |
| +		read_offset = 0;
 | |
| +		write_offset = 0;
 | |
| +		break;
 | |
| +
 | |
| +	case NAND_CMD_READ0:
 | |
| +		read_offset = page_addr * pagesize;
 | |
| +		nflash->next_opcode = 0;
 | |
| +		break;
 | |
| +
 | |
| +	case NAND_CMD_READOOB:
 | |
| +		read_offset = page_addr * pagesize;
 | |
| +		nflash->next_opcode = 0;
 | |
| +		break;
 | |
| +
 | |
| +	case NAND_CMD_SEQIN:
 | |
| +		write_offset = page_addr * pagesize;
 | |
| +		nflash->next_opcode = 0;
 | |
| +		break;
 | |
| +
 | |
| +	case NAND_CMD_PAGEPROG:
 | |
| +		nflash->next_opcode = 0;
 | |
| +		break;
 | |
| +
 | |
| +	case NAND_CMD_READID:
 | |
| +		read_offset = column;
 | |
| +		bcm47xx_nflash_cmd(nflash->bcc, NCMD_ID_RD);
 | |
| +		nflash->next_opcode = NAND_DEVID;
 | |
| +		break;
 | |
| +
 | |
| +	case NAND_CMD_ERASE1:
 | |
| +		nflash->next_opcode = 0;
 | |
| +		bcm47xx_nflash_erase(mtd, page_addr*pagesize, pagesize);
 | |
| +		break;
 | |
| +
 | |
| +	case NAND_CMD_ERASE2:
 | |
| +		break;
 | |
| +
 | |
| +	case NAND_CMD_RNDOUT:
 | |
| +		if (column > mtd->writesize)
 | |
| +			read_offset += (column - mtd->writesize);
 | |
| +		else
 | |
| +			read_offset += column;
 | |
| +		break;
 | |
| +
 | |
| +	default:
 | |
| +		pr_err("COMMAND not supported %x\n", command);
 | |
| +		nflash->next_opcode = 0;
 | |
| +		break;
 | |
| +	}
 | |
| +}
 | |
| +
 | |
| +/* This function is used by upper layer for select and
 | |
| + * deselect of the NAND chip.
 | |
| + * It is dummy function. */
 | |
| +static void bcm47xx_nflash_select_chip(struct mtd_info *mtd, int chip)
 | |
| +{
 | |
| +}
 | |
| +
 | |
| +static u_char bcm47xx_nflash_read_byte(struct mtd_info *mtd)
 | |
| +{
 | |
| +	struct nand_chip *nchip = mtd->priv;
 | |
| +	struct bcm47xx_nflash *nflash = (struct bcm47xx_nflash *)nchip->priv;
 | |
| +	uint8_t ret = 0;
 | |
| +	static u32 id;
 | |
| +
 | |
| +	if (nflash->next_opcode == 0)
 | |
| +		return ret;
 | |
| +
 | |
| +	if (nflash->next_opcode == NAND_CMD_STATUS)
 | |
| +		return NAND_STATUS_WP;
 | |
| +
 | |
| +	id = bcma_cc_read32(nflash->bcc, nflash->next_opcode);
 | |
| +
 | |
| +	if (nflash->next_opcode == NAND_DEVID) {
 | |
| +		ret = (id >> (8*read_offset)) & 0xff;
 | |
| +		read_offset++;
 | |
| +	}
 | |
| +
 | |
| +	return ret;
 | |
| +}
 | |
| +
 | |
| +static uint16_t bcm47xx_nflash_read_word(struct mtd_info *mtd)
 | |
| +{
 | |
| +	loff_t from = read_offset;
 | |
| +	uint16_t buf = 0;
 | |
| +	int bytes;
 | |
| +
 | |
| +	bcm47xx_nflash_read(mtd, from, sizeof(buf), &bytes, (u_char *)&buf);
 | |
| +	return buf;
 | |
| +}
 | |
| +
 | |
| +/* Write data of length len to buffer buf. The data to be
 | |
| + * written on NAND Flash is first copied to RAMbuffer. After the Data Input
 | |
| + * Operation by the NFC, the data is written to NAND Flash */
 | |
| +static void bcm47xx_nflash_write_buf(struct mtd_info *mtd,
 | |
| +				const u_char *buf, int len)
 | |
| +{
 | |
| +	bcm47xx_nflash_write(mtd, write_offset, buf, len);
 | |
| +}
 | |
| +
 | |
| +/* Read the data buffer from the NAND Flash. To read the data from NAND
 | |
| + * Flash first the data output cycle is initiated by the NFC, which copies
 | |
| + * the data to RAMbuffer. This data of length len is then copied to buffer buf.
 | |
| + */
 | |
| +static void bcm47xx_nflash_read_buf(struct mtd_info *mtd, u_char *buf, int len)
 | |
| +{
 | |
| +	loff_t from = read_offset;
 | |
| +	int bytes;
 | |
| +
 | |
| +	bcm47xx_nflash_read(mtd, from, len, &bytes, buf);
 | |
| +}
 | |
| +
 | |
| +/* Used by the upper layer to verify the data in NAND Flash
 | |
| + * with the data in the buf. */
 | |
| +static int bcm47xx_nflash_verify_buf(struct mtd_info *mtd,
 | |
| +				const u_char *buf, int len)
 | |
| +{
 | |
| +	return -EFAULT;
 | |
| +}
 | |
| +
 | |
| +static int bcm47xx_nflash_block_bad(struct mtd_info *mtd, loff_t ofs, int getchip)
 | |
| +{
 | |
| +	struct nand_chip *nchip = mtd->priv;
 | |
| +	struct bcm47xx_nflash *nflash = (struct bcm47xx_nflash *)nchip->priv;
 | |
| +	int i;
 | |
| +	uint off;
 | |
| +	u32 pagesize = 1 << nchip->page_shift;
 | |
| +	u32 blocksize = mtd->erasesize;
 | |
| +
 | |
| +	if ((ofs >> 20) >= nflash->size)
 | |
| +		return 1;
 | |
| +	if ((ofs & (blocksize - 1)) != 0)
 | |
| +		return 1;
 | |
| +
 | |
| +	for (i = 0; i < 2; i++) {
 | |
| +		off = ofs + pagesize;
 | |
| +		bcma_cc_write32(nflash->bcc, NAND_CMD_ADDR, off);
 | |
| +		bcm47xx_nflash_cmd(nflash->bcc, NCMD_SPARE_RD);
 | |
| +		if (bcma_nflash_poll(nflash->bcc) < 0)
 | |
| +			break;
 | |
| +		if ((bcma_cc_read32(nflash->bcc, NAND_INTFC_STATUS) & NIST_SPARE_VALID) != NIST_SPARE_VALID)
 | |
| +			return 1;
 | |
| +		if ((bcma_cc_read32(nflash->bcc, NAND_SPARE_RD0) & 0xff) != 0xff)
 | |
| +			return 1;
 | |
| +	}
 | |
| +	return 0;
 | |
| +}
 | |
| +
 | |
| +const char *part_probes[] = { "cmdlinepart", NULL };
 | |
| +static int bcm47xx_nflash_probe(struct platform_device *pdev)
 | |
| +{
 | |
| +	struct nand_chip *nchip;
 | |
| +	struct mtd_info *mtd;
 | |
| +	struct bcm47xx_nflash *nflash = dev_get_platdata(&pdev->dev);
 | |
| +	int ret = 0;
 | |
| +
 | |
| +	mtd = kzalloc(sizeof(struct mtd_info), GFP_KERNEL);
 | |
| +	if (!mtd){
 | |
| +		ret = -ENOMEM;
 | |
| +		goto err_out;
 | |
| +	}
 | |
| +
 | |
| +	nchip = kzalloc(sizeof(struct nand_chip), GFP_KERNEL);
 | |
| +	if (!nchip) {
 | |
| +		ret = -ENOMEM;
 | |
| +		goto err_free_mtd;
 | |
| +	}
 | |
| +
 | |
| +	/* Register with MTD */
 | |
| +	mtd->priv = nchip;
 | |
| +	mtd->owner = THIS_MODULE;
 | |
| +	mtd->dev.parent = &pdev->dev;
 | |
| +
 | |
| +	/* 50 us command delay time */
 | |
| +	nchip->chip_delay = 50;
 | |
| +
 | |
| +	nchip->priv = nflash;
 | |
| +	nchip->dev_ready = bcm47xx_nflash_dev_ready;
 | |
| +	nchip->cmdfunc = bcm47xx_nflash_command;
 | |
| +	nchip->select_chip = bcm47xx_nflash_select_chip;
 | |
| +	nchip->read_byte = bcm47xx_nflash_read_byte;
 | |
| +	nchip->read_word = bcm47xx_nflash_read_word;
 | |
| +	nchip->write_buf = bcm47xx_nflash_write_buf;
 | |
| +	nchip->read_buf = bcm47xx_nflash_read_buf;
 | |
| +	nchip->verify_buf = bcm47xx_nflash_verify_buf;
 | |
| +	nchip->block_bad = bcm47xx_nflash_block_bad;
 | |
| +	nchip->options = NAND_SKIP_BBTSCAN;
 | |
| +
 | |
| +	/* Not known */
 | |
| +	nchip->ecc.mode = NAND_ECC_NONE;
 | |
| +
 | |
| +	/* first scan to find the device and get the page size */
 | |
| +	if (nand_scan_ident(mtd, 1, NULL)) {
 | |
| +		pr_err("nand_scan_ident failed\n");
 | |
| +		ret = -ENXIO;
 | |
| +		goto err_free_nchip;
 | |
| +	}
 | |
| +	nflash->size = mtd->size;
 | |
| +	nflash->pagesize = 1 << nchip->page_shift;
 | |
| +	nflash->blocksize = mtd->erasesize;
 | |
| +	nflash->mtd = mtd;
 | |
| +
 | |
| +	/* second phase scan */
 | |
| +	if (nand_scan_tail(mtd)) {
 | |
| +		pr_err("nand_scan_tail failed\n");
 | |
| +		ret = -ENXIO;
 | |
| +		goto err_free_nchip;
 | |
| +	}
 | |
| +
 | |
| +	mtd->name = "bcm47xx-nflash";
 | |
| +	mtd->flags |= MTD_WRITEABLE;
 | |
| +	ret = mtd_device_parse_register(mtd, part_probes, NULL, NULL, 0);
 | |
| +
 | |
| +	if (ret) {
 | |
| +		pr_err("mtd_device_register failed\n");
 | |
| +		goto err_free_nchip;
 | |
| +	}
 | |
| +
 | |
| +	return 0;
 | |
| +
 | |
| +err_free_nchip:
 | |
| +	kfree(nchip);
 | |
| +err_free_mtd:
 | |
| +	kfree(mtd);
 | |
| +err_out:
 | |
| +	return ret;
 | |
| +}
 | |
| +
 | |
| +static int __devexit bcm47xx_nflash_remove(struct platform_device *pdev)
 | |
| +{
 | |
| +	struct bcm47xx_nflash *nflash = dev_get_platdata(&pdev->dev);
 | |
| +	struct mtd_info *mtd = nflash->mtd;
 | |
| +
 | |
| +	if (nflash) {
 | |
| +		/* Release resources, unregister device */
 | |
| +		nand_release(mtd);
 | |
| +		kfree(mtd->priv);
 | |
| +		kfree(mtd);
 | |
| +	}
 | |
| +
 | |
| +	return 0;
 | |
| +}
 | |
| +
 | |
| +static const struct platform_device_id bcm47xx_nflash_table[] = {
 | |
| +	{ "bcm47xx-nflash", 0 },
 | |
| +	{ }
 | |
| +};
 | |
| +MODULE_DEVICE_TABLE(platform, bcm47xx_nflash_table);
 | |
| +
 | |
| +static struct platform_driver bcm47xx_nflash_driver = {
 | |
| +	.id_table	= bcm47xx_nflash_table,
 | |
| +	.probe	= bcm47xx_nflash_probe,
 | |
| +	.remove	= __devexit_p(bcm47xx_nflash_remove),
 | |
| +	.driver	= {
 | |
| +		.name = "bcm47xx-nflash",
 | |
| +		.owner = THIS_MODULE,
 | |
| +	},
 | |
| +};
 | |
| +
 | |
| +static int __init init_bcm47xx_nflash(void)
 | |
| +{
 | |
| +	int ret = platform_driver_register(&bcm47xx_nflash_driver);
 | |
| +
 | |
| +	if (ret)
 | |
| +		pr_err("error registering platform driver: %i\n", ret);
 | |
| +	return ret;
 | |
| +}
 | |
| +
 | |
| +static void __exit exit_bcm47xx_nflash(void)
 | |
| +{
 | |
| +	platform_driver_unregister(&bcm47xx_nflash_driver);
 | |
| +}
 | |
| +
 | |
| +module_init(init_bcm47xx_nflash);
 | |
| +module_exit(exit_bcm47xx_nflash);
 | |
| +
 | |
| +MODULE_LICENSE("GPL");
 | |
| +MODULE_DESCRIPTION("BCM47XX NAND flash driver");
 | |
| --- /dev/null
 | |
| +++ b/include/linux/mtd/bcm47xx_nand.h
 | |
| @@ -0,0 +1,152 @@
 | |
| +/*
 | |
| + * Broadcom chipcommon NAND flash interface
 | |
| + *
 | |
| + * Copyright (C) 2011-2012 Tathagata Das <tathagata@alumnux.com>
 | |
| + * Copyright (C) 2009, Broadcom Corporation
 | |
| + * All Rights Reserved.
 | |
| + *
 | |
| + * THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY
 | |
| + * KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
 | |
| + * SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
 | |
| + * FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
 | |
| + *
 | |
| + */
 | |
| +
 | |
| +#ifndef LINUX_MTD_BCM47XX_NAND_H_
 | |
| +#define LINUX_MTD_BCM47XX_NAND_H_
 | |
| +
 | |
| +#include <linux/mtd/mtd.h>
 | |
| +
 | |
| +#define  NAND_FLASH1						0x1fc00000  /* MIPS Flash Region 1 */
 | |
| +
 | |
| +/* nand_cmd_start commands */
 | |
| +#define	NCMD_NULL						0
 | |
| +#define	NCMD_PAGE_RD					1
 | |
| +#define	NCMD_SPARE_RD					2
 | |
| +#define	NCMD_STATUS_RD					3
 | |
| +#define	NCMD_PAGE_PROG					4
 | |
| +#define	NCMD_SPARE_PROG				5
 | |
| +#define	NCMD_COPY_BACK					6
 | |
| +#define	NCMD_ID_RD						7
 | |
| +#define	NCMD_BLOCK_ERASE				8
 | |
| +#define	NCMD_FLASH_RESET				9
 | |
| +#define	NCMD_LOCK						0xa
 | |
| +#define	NCMD_LOCK_DOWN					0xb
 | |
| +#define	NCMD_UNLOCK						0xc
 | |
| +#define	NCMD_LOCK_STATUS				0xd
 | |
| +
 | |
| +/* nand_acc_control */
 | |
| +#define	NAC_RD_ECC_EN					0x80000000
 | |
| +#define	NAC_WR_ECC_EN					0x40000000
 | |
| +#define	NAC_RD_ECC_BLK0_EN			0x20000000
 | |
| +#define	NAC_FAST_PGM_RDIN				0x10000000
 | |
| +#define	NAC_RD_ERASED_ECC_EN			0x08000000
 | |
| +#define	NAC_PARTIAL_PAGE_EN			0x04000000
 | |
| +#define	NAC_PAGE_HIT_EN				0x01000000
 | |
| +#define	NAC_ECC_LEVEL0					0x00f00000
 | |
| +#define	NAC_ECC_LEVEL					0x000f0000
 | |
| +#define	NAC_SPARE_SIZE0				0x00003f00
 | |
| +#define	NAC_SPARE_SIZE					0x0000003f
 | |
| +
 | |
| +/* nand_config */
 | |
| +#define	NCF_CONFIG_LOCK				0x80000000
 | |
| +#define	NCF_BLOCK_SIZE_MASK			0x70000000
 | |
| +#define	NCF_BLOCK_SIZE_SHIFT			28
 | |
| +#define	NCF_DEVICE_SIZE_MASK			0x0f000000
 | |
| +#define	NCF_DEVICE_SIZE_SHIFT		24
 | |
| +#define	NCF_DEVICE_WIDTH				0x00800000
 | |
| +#define	NCF_PAGE_SIZE_MASK			0x00300000
 | |
| +#define	NCF_PAGE_SIZE_SHIFT			20
 | |
| +#define	NCF_FULL_ADDR_BYTES_MASK	0x00070000
 | |
| +#define	NCF_FULL_ADDR_BYTES_SHIFT	16
 | |
| +#define	NCF_COL_ADDR_BYTES_MASK		0x00007000
 | |
| +#define	NCF_COL_ADDR_BYTES_SHIFT	12
 | |
| +#define	NCF_BLK_ADDR_BYTES_MASK		0x00000700
 | |
| +#define	NCF_BLK_ADDR_BYTES_SHIFT	8
 | |
| +
 | |
| +/* nand_intfc_status */
 | |
| +#define	NIST_CTRL_READY				0x80000000
 | |
| +#define	NIST_FLASH_READY				0x40000000
 | |
| +#define	NIST_CACHE_VALID				0x20000000
 | |
| +#define	NIST_SPARE_VALID				0x10000000
 | |
| +#define	NIST_ERASED						0x08000000
 | |
| +#define	NIST_STATUS						0x000000ff
 | |
| +
 | |
| +#define	NFL_SECTOR_SIZE				512
 | |
| +
 | |
| +#define	NFL_TABLE_END					0xffffffff
 | |
| +#define	NFL_BOOT_SIZE					0x200000
 | |
| +#define	NFL_BOOT_OS_SIZE				0x2000000
 | |
| +
 | |
| +/* Nand flash MLC controller registers (corerev >= 38) */
 | |
| +#define	NAND_REVISION					0xC00
 | |
| +#define	NAND_CMD_START					0xC04
 | |
| +#define	NAND_CMD_ADDR_X				0xC08
 | |
| +#define	NAND_CMD_ADDR					0xC0C
 | |
| +#define	NAND_CMD_END_ADDR				0xC10
 | |
| +#define	NAND_CS_NAND_SELECT			0xC14
 | |
| +#define	NAND_CS_NAND_XOR				0xC18
 | |
| +#define	NAND_SPARE_RD0					0xC20
 | |
| +#define	NAND_SPARE_RD4					0xC24
 | |
| +#define	NAND_SPARE_RD8					0xC28
 | |
| +#define	NAND_SPARE_RD12				0xC2C
 | |
| +#define	NAND_SPARE_WR0					0xC30
 | |
| +#define	NAND_SPARE_WR4					0xC34
 | |
| +#define	NAND_SPARE_WR8					0xC38
 | |
| +#define	NAND_SPARE_WR12				0xC3C
 | |
| +#define	NAND_ACC_CONTROL				0xC40
 | |
| +#define	NAND_CONFIG						0xC48
 | |
| +#define	NAND_TIMING_1					0xC50
 | |
| +#define	NAND_TIMING_2					0xC54
 | |
| +#define	NAND_SEMAPHORE					0xC58
 | |
| +#define	NAND_DEVID						0xC60
 | |
| +#define	NAND_DEVID_X					0xC64
 | |
| +#define	NAND_BLOCK_LOCK_STATUS		0xC68
 | |
| +#define	NAND_INTFC_STATUS				0xC6C
 | |
| +#define	NAND_ECC_CORR_ADDR_X			0xC70
 | |
| +#define	NAND_ECC_CORR_ADDR			0xC74
 | |
| +#define	NAND_ECC_UNC_ADDR_X			0xC78
 | |
| +#define	NAND_ECC_UNC_ADDR				0xC7C
 | |
| +#define	NAND_READ_ERROR_COUNT		0xC80
 | |
| +#define	NAND_CORR_STAT_THRESHOLD	0xC84
 | |
| +#define	NAND_READ_ADDR_X				0xC90
 | |
| +#define	NAND_READ_ADDR					0xC94
 | |
| +#define	NAND_PAGE_PROGRAM_ADDR_X	0xC98
 | |
| +#define	NAND_PAGE_PROGRAM_ADDR		0xC9C
 | |
| +#define	NAND_COPY_BACK_ADDR_X		0xCA0
 | |
| +#define	NAND_COPY_BACK_ADDR			0xCA4
 | |
| +#define	NAND_BLOCK_ERASE_ADDR_X		0xCA8
 | |
| +#define	NAND_BLOCK_ERASE_ADDR		0xCAC
 | |
| +#define	NAND_INV_READ_ADDR_X			0xCB0
 | |
| +#define	NAND_INV_READ_ADDR			0xCB4
 | |
| +#define	NAND_BLK_WR_PROTECT			0xCC0
 | |
| +#define	NAND_ACC_CONTROL_CS1			0xCD0
 | |
| +#define	NAND_CONFIG_CS1				0xCD4
 | |
| +#define	NAND_TIMING_1_CS1				0xCD8
 | |
| +#define	NAND_TIMING_2_CS1				0xCDC
 | |
| +#define	NAND_SPARE_RD16				0xD30
 | |
| +#define	NAND_SPARE_RD20				0xD34
 | |
| +#define	NAND_SPARE_RD24				0xD38
 | |
| +#define	NAND_SPARE_RD28				0xD3C
 | |
| +#define	NAND_CACHE_ADDR				0xD40
 | |
| +#define	NAND_CACHE_DATA				0xD44
 | |
| +#define	NAND_CTRL_CONFIG				0xD48
 | |
| +#define	NAND_CTRL_STATUS				0xD4C
 | |
| +
 | |
| +struct bcma_drv_cc;
 | |
| +
 | |
| +struct bcm47xx_nflash {
 | |
| +	struct bcma_drv_cc *bcc;
 | |
| +
 | |
| +	bool present;
 | |
| +	bool boot;		/* This is the flash the SoC boots from */
 | |
| +	u32 blocksize;		/* Block size */
 | |
| +	u32 pagesize;		/* Page size */
 | |
| +
 | |
| +	u32 size;		/* Total size in bytes */
 | |
| +	u32 next_opcode; /* Next expected command from upper NAND layer */
 | |
| +
 | |
| +	struct mtd_info *mtd;
 | |
| +};
 | |
| +
 | |
| +#endif /* LINUX_MTD_BCM47XX_NAND_H_ */
 |