diff options
Diffstat (limited to 'target/linux/storm/patches/1020-mtd.patch')
| -rw-r--r-- | target/linux/storm/patches/1020-mtd.patch | 4981 |
1 files changed, 4981 insertions, 0 deletions
diff --git a/target/linux/storm/patches/1020-mtd.patch b/target/linux/storm/patches/1020-mtd.patch new file mode 100644 index 0000000000..2c102d6025 --- /dev/null +++ b/target/linux/storm/patches/1020-mtd.patch @@ -0,0 +1,4981 @@ +Index: linux-2.6.23.16/drivers/mtd/chips/Kconfig +=================================================================== +--- linux-2.6.23.16.orig/drivers/mtd/chips/Kconfig 2008-03-15 17:03:14.374622039 +0200 ++++ linux-2.6.23.16/drivers/mtd/chips/Kconfig 2008-03-15 17:03:17.874821522 +0200 +@@ -220,6 +220,13 @@ + This option enables basic support for ROM chips accessed through + a bus mapping driver. + ++config MTD_SERIAL ++ tristate "Support for Serial chips in bus mapping" ++ depends on MTD ++ help ++ This option enables basic support for Serial chips accessed through ++ a bus mapping driver. ++ + config MTD_ABSENT + tristate "Support for absent chips in bus mapping" + help +Index: linux-2.6.23.16/drivers/mtd/chips/cfi_cmdset_0002.c +=================================================================== +--- linux-2.6.23.16.orig/drivers/mtd/chips/cfi_cmdset_0002.c 2008-03-15 17:03:14.374622039 +0200 ++++ linux-2.6.23.16/drivers/mtd/chips/cfi_cmdset_0002.c 2008-03-15 17:03:17.874821522 +0200 +@@ -39,10 +39,15 @@ + #include <linux/mtd/cfi.h> + #include <linux/mtd/xip.h> + ++//****** Storlink SoC ****** + #define AMD_BOOTLOC_BUG +-#define FORCE_WORD_WRITE 0 +- +-#define MAX_WORD_RETRIES 3 ++//#define FORCE_WORD_WRITE 0 ++#define FORCE_WORD_WRITE 1 ++#define FORCE_FAST_PROG 0 ++ ++//#define MAX_WORD_RETRIES 3 ++#define MAX_WORD_RETRIES 3 // CONFIG_MTD_CFI_AMDSTD_RETRY ++//************************** + + #define MANUFACTURER_AMD 0x0001 + #define MANUFACTURER_ATMEL 0x001F +@@ -322,6 +327,13 @@ + #endif + + bootloc = extp->TopBottom; ++//****** Storlink SoC ****** ++ if(bootloc == 5) ++ { ++ bootloc = 3; ++ extp->TopBottom = 3; ++ } ++//************************** + if ((bootloc != 2) && (bootloc != 3)) { + printk(KERN_WARNING "%s: CFI does not contain boot " + "bank location. Assuming top.\n", map->name); +@@ -340,6 +352,9 @@ + cfi->cfiq->EraseRegionInfo[j] = swap; + } + } ++#ifdef CONFIG_MTD_MAP_BANK_WIDTH_1 ++ cfi->device_type = CFI_DEVICETYPE_X8; ++#endif + /* Set the default CFI lock/unlock addresses */ + cfi->addr_unlock1 = 0x555; + cfi->addr_unlock2 = 0x2aa; +@@ -461,6 +476,7 @@ + map_word d, t; + + d = map_read(map, addr); ++ udelay(20); //Storlink SoC + t = map_read(map, addr); + + return map_word_equal(map, d, t); +@@ -626,7 +642,9 @@ + default: + printk(KERN_ERR "MTD: put_chip() called with oldstate %d!!\n", chip->oldstate); + } ++//****** Storlink SoC ****** + wake_up(&chip->wq); ++//************************** + } + + #ifdef CONFIG_MTD_XIP +@@ -940,7 +958,9 @@ + cfi_send_gen_cmd(0x90, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); + cfi_send_gen_cmd(0x00, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); + ++//****** Storlink SoC ****** + wake_up(&chip->wq); ++//************************** + spin_unlock(chip->mutex); + + return 0; +@@ -1005,7 +1025,10 @@ + */ + unsigned long uWriteTimeout = ( HZ / 1000 ) + 1; + int ret = 0; +- map_word oldd; ++//****** Storlink SoC ****** ++// map_word oldd; ++ map_word oldd, tmp; ++//************************** + int retry_cnt = 0; + + adr += chip->start; +@@ -1037,9 +1060,15 @@ + ENABLE_VPP(map); + xip_disable(map, chip, adr); + retry: ++//****** Storlink SoC ****** ++#if FORCE_FAST_PROG /* Unlock bypass */ ++ cfi_send_gen_cmd(0xA0, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); ++#else + cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); + cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); + cfi_send_gen_cmd(0xA0, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); ++#endif ++//************************** + map_write(map, datum, adr); + chip->state = FL_WRITING; + +@@ -1072,7 +1101,13 @@ + } + + if (chip_ready(map, adr)) +- break; ++ { ++ tmp = map_read(map, adr); ++ if(map_word_equal(map, tmp, datum)) ++// goto op_done; ++ break; ++ ++ } + + /* Latency issues. Drop the lock, wait a while and retry */ + UDELAY(map, chip, adr, 1); +@@ -1084,8 +1119,17 @@ + /* FIXME - should have reset delay before continuing */ + + if (++retry_cnt <= MAX_WORD_RETRIES) ++ { ++//****** Storlink SoC ****** ++#if FORCE_FAST_PROG ++ cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); ++ cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); ++ cfi_send_gen_cmd(0x20, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); ++ //udelay(1); ++#endif ++ udelay(1); + goto retry; +- ++ } + ret = -EIO; + } + xip_enable(map, chip, adr); +@@ -1171,7 +1215,14 @@ + return 0; + } + } +- ++//****** Storlink SoC ****** ++ map_write( map, CMD(0xF0), chipstart ); ++#if FORCE_FAST_PROG ++ cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chipstart, map, cfi, cfi->device_type, NULL); ++ cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chipstart, map, cfi, cfi->device_type, NULL); ++ cfi_send_gen_cmd(0x20, cfi->addr_unlock1, chipstart, map, cfi, cfi->device_type, NULL); ++#endif ++//************************** + /* We are now aligned, write as much as possible */ + while(len >= map_bankwidth(map)) { + map_word datum; +@@ -1181,7 +1232,15 @@ + ret = do_write_oneword(map, &cfi->chips[chipnum], + ofs, datum); + if (ret) ++ { ++//****** Storlink SoC ****** ++#if FORCE_FAST_PROG ++ /* Get out of unlock bypass mode */ ++ cfi_send_gen_cmd(0x90, 0, chipstart, map, cfi, cfi->device_type, NULL); ++ cfi_send_gen_cmd(0x00, 0, chipstart, map, cfi, cfi->device_type, NULL); ++#endif + return ret; ++ } + + ofs += map_bankwidth(map); + buf += map_bankwidth(map); +@@ -1189,19 +1248,38 @@ + len -= map_bankwidth(map); + + if (ofs >> cfi->chipshift) { ++//****** Storlink SoC ****** ++#if FORCE_FAST_PROG ++ /* Get out of unlock bypass mode */ ++ cfi_send_gen_cmd(0x90, 0, chipstart, map, cfi, cfi->device_type, NULL); ++ cfi_send_gen_cmd(0x00, 0, chipstart, map, cfi, cfi->device_type, NULL); ++#endif + chipnum ++; + ofs = 0; + if (chipnum == cfi->numchips) + return 0; + chipstart = cfi->chips[chipnum].start; ++#if FORCE_FAST_PROG ++ /* Go into unlock bypass mode for next set of chips */ ++ cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chipstart, map, cfi, cfi->device_type, NULL); ++ cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chipstart, map, cfi, cfi->device_type, NULL); ++ cfi_send_gen_cmd(0x20, cfi->addr_unlock1, chipstart, map, cfi, cfi->device_type, NULL); ++#endif + } + } + ++#if FORCE_FAST_PROG ++ /* Get out of unlock bypass mode */ ++ cfi_send_gen_cmd(0x90, 0, chipstart, map, cfi, cfi->device_type, NULL); ++ cfi_send_gen_cmd(0x00, 0, chipstart, map, cfi, cfi->device_type, NULL); ++#endif ++ + /* Write the trailing bytes if any */ + if (len & (map_bankwidth(map)-1)) { + map_word tmp_buf; + + retry1: ++ + spin_lock(cfi->chips[chipnum].mutex); + + if (cfi->chips[chipnum].state != FL_READY) { +@@ -1221,7 +1299,11 @@ + #endif + goto retry1; + } +- ++#if FORCE_FAST_PROG ++ cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chipstart, map, cfi, cfi->device_type, NULL); ++ cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chipstart, map, cfi, cfi->device_type, NULL); ++ cfi_send_gen_cmd(0x20, cfi->addr_unlock1, chipstart, map, cfi, cfi->device_type, NULL); ++#endif + tmp_buf = map_read(map, ofs + chipstart); + + spin_unlock(cfi->chips[chipnum].mutex); +@@ -1231,11 +1313,23 @@ + ret = do_write_oneword(map, &cfi->chips[chipnum], + ofs, tmp_buf); + if (ret) ++ { ++#if FORCE_FAST_PROG ++ /* Get out of unlock bypass mode */ ++ cfi_send_gen_cmd(0x90, 0, chipstart, map, cfi, cfi->device_type, NULL); ++ cfi_send_gen_cmd(0x00, 0, chipstart, map, cfi, cfi->device_type, NULL); ++#endif + return ret; +- ++ } ++#if FORCE_FAST_PROG ++ /* Get out of unlock bypass mode */ ++ cfi_send_gen_cmd(0x90, 0, chipstart, map, cfi, cfi->device_type, NULL); ++ cfi_send_gen_cmd(0x00, 0, chipstart, map, cfi, cfi->device_type, NULL); ++#endif + (*retlen) += len; + } + ++ map_write( map, CMD(0xF0), chipstart ); + return 0; + } + +@@ -1275,6 +1369,7 @@ + ENABLE_VPP(map); + xip_disable(map, chip, cmd_adr); + ++ map_write( map, CMD(0xF0), chip->start ); //Storlink + cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); + cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); + //cfi_send_gen_cmd(0xA0, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); +@@ -1535,6 +1630,9 @@ + DECLARE_WAITQUEUE(wait, current); + int ret = 0; + ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_lock(); // sl2312 share pin lock ++#endif + adr += chip->start; + + spin_lock(chip->mutex); +@@ -1613,6 +1711,9 @@ + chip->state = FL_READY; + put_chip(map, chip, adr); + spin_unlock(chip->mutex); ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return ret; + } + +Index: linux-2.6.23.16/drivers/mtd/chips/map_serial.c +=================================================================== +--- /dev/null 1970-01-01 00:00:00.000000000 +0000 ++++ linux-2.6.23.16/drivers/mtd/chips/map_serial.c 2008-03-15 17:03:17.874821522 +0200 +@@ -0,0 +1,188 @@ ++/* ++ * Common code to handle map devices which are simple ROM ++ * (C) 2000 Red Hat. GPL'd. ++ * $Id: map_serial.c,v 1.3 2006/06/05 02:34:54 middle Exp $ ++ */ ++ ++#include <linux/version.h> ++#include <linux/module.h> ++#include <linux/types.h> ++#include <linux/kernel.h> ++#include <asm/io.h> ++ ++#include <asm/byteorder.h> ++#include <linux/errno.h> ++#include <linux/slab.h> ++ ++#include <asm/hardware.h> ++#include <linux/mtd/map.h> ++#include <linux/mtd/mtd.h> ++#include <linux/init.h> //add ++#include <asm/arch/sl2312.h> ++#include <asm/arch/flash.h> ++ ++static int mapserial_erase(struct mtd_info *mtd, struct erase_info *instr); ++static int mapserial_read (struct mtd_info *, loff_t, size_t, size_t *, u_char *); ++static int mapserial_write (struct mtd_info *, loff_t, size_t, size_t *, const u_char *); ++static void mapserial_nop (struct mtd_info *); ++struct mtd_info *map_serial_probe(struct map_info *map); ++ ++extern int m25p80_sector_erase(__u32 address, __u32 schip_en); ++ ++static struct mtd_chip_driver mapserial_chipdrv = { ++ probe: map_serial_probe, ++ name: "map_serial", ++ module: THIS_MODULE ++}; ++ ++struct mtd_info *map_serial_probe(struct map_info *map) ++{ ++ struct mtd_info *mtd; ++ ++ mtd = kmalloc(sizeof(*mtd), GFP_KERNEL); ++ if (!mtd) ++ return NULL; ++ ++ memset(mtd, 0, sizeof(*mtd)); ++ ++ map->fldrv = &mapserial_chipdrv; ++ mtd->priv = map; ++ mtd->name = map->name; ++ mtd->type = MTD_OTHER; ++ mtd->erase = mapserial_erase; ++ mtd->size = map->size; ++ mtd->read = mapserial_read; ++ mtd->write = mapserial_write; ++ mtd->sync = mapserial_nop; ++ mtd->flags = (MTD_WRITEABLE|MTD_ERASEABLE); ++// mtd->erasesize = 512; // page size; ++#ifdef CONFIG_MTD_SL2312_SERIAL_ST ++ mtd->erasesize = M25P80_SECTOR_SIZE; // block size; ++#else ++ mtd->erasesize = 0x1000; // block size; ++#endif ++ ++ __module_get(THIS_MODULE); ++ //MOD_INC_USE_COUNT; ++ return mtd; ++} ++ ++#define FLASH_ACCESS_OFFSET 0x00000010 ++#define FLASH_ADDRESS_OFFSET 0x00000014 ++#define FLASH_WRITE_DATA_OFFSET 0x00000018 ++#define FLASH_READ_DATA_OFFSET 0x00000018 ++ ++static __u32 readflash_ctrl_reg(__u32 ofs) ++{ ++ __u32 *base; ++ ++ base = (__u32 *)IO_ADDRESS((SL2312_FLASH_CTRL_BASE + ofs)); ++ return __raw_readl(base); ++} ++ ++static void writeflash_ctrl_reg(__u32 data, __u32 ofs) ++{ ++ __u32 *base; ++ ++ base = (__u32 *)IO_ADDRESS((SL2312_FLASH_CTRL_BASE + ofs)); ++ __raw_writel(data, base); ++} ++ ++static int mapserial_erase_block(struct map_info *map,unsigned int block) ++{ ++ ++ __u32 address; ++#ifdef CONFIG_MTD_SL2312_SERIAL_ST ++ ++ if(!m25p80_sector_erase(block, 0)) ++ return (MTD_ERASE_DONE); ++#else ++ __u32 opcode; ++ __u32 count=0; ++// __u8 status; ++ ++ // printk("mapserial_erase_block : erase block %d \n",block); ++// opcode = 0x80000000 | FLASH_ACCESS_ACTION_SHIFT_ADDRESS | cmd; ++ opcode = 0x80000000 | 0x0200 | 0x50; ++ address = (block << 13); ++ writeflash_ctrl_reg(address,FLASH_ADDRESS_OFFSET); ++ writeflash_ctrl_reg(opcode,FLASH_ACCESS_OFFSET); ++ opcode=readflash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(opcode&0x80000000) ++ { ++ opcode = readflash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ count++; ++ if (count > 10000) ++ { ++ return (MTD_ERASE_FAILED); ++ } ++ } ++ return (MTD_ERASE_DONE); ++#endif ++} ++ ++static int mapserial_erase(struct mtd_info *mtd, struct erase_info *instr) ++{ ++ struct map_info *map = (struct map_info *)mtd->priv; ++ unsigned int addr; ++ int len; ++ unsigned int block; ++ unsigned int ret=0; ++ ++ addr = instr->addr; ++ len = instr->len; ++ while (len > 0) ++ { ++ block = addr / mtd->erasesize; ++#ifdef CONFIG_MTD_SL2312_SERIAL_ST ++ ret = mapserial_erase_block(map,addr); ++#else ++ ret = mapserial_erase_block(map,block); ++#endif ++ addr = addr + mtd->erasesize; ++ len = len - mtd->erasesize; ++ } ++ return (ret); ++} ++ ++static int mapserial_read (struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf) ++{ ++ struct map_info *map = (struct map_info *)mtd->priv; ++// printk("mapserial_read : \n"); ++ map->copy_from(map, buf, from, len); ++ *retlen = len; ++ return 0; ++} ++ ++static void mapserial_nop(struct mtd_info *mtd) ++{ ++ /* Nothing to see here */ ++} ++ ++static int mapserial_write (struct mtd_info *mtd, loff_t to, size_t len, size_t *retlen, const u_char *buf) ++{ ++ struct map_info *map = (struct map_info *)mtd->priv; ++// printk("mapserial_write : buf %x to %x len %x \n",(int)buf, (int)to, (int)len); ++ //map->copy_to(map, buf, to, len); ++ map->copy_to(map, to, buf, len); ++ *retlen = len; ++ return 0; ++} ++ ++int __init map_serial_init(void) ++{ ++ register_mtd_chip_driver(&mapserial_chipdrv); ++ return 0; ++} ++ ++static void __exit map_serial_exit(void) ++{ ++ unregister_mtd_chip_driver(&mapserial_chipdrv); ++} ++ ++module_init(map_serial_init); ++module_exit(map_serial_exit); ++ ++MODULE_LICENSE("GPL"); ++MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>"); ++MODULE_DESCRIPTION("MTD chip driver for ROM chips"); +Index: linux-2.6.23.16/drivers/mtd/maps/Kconfig +=================================================================== +--- linux-2.6.23.16.orig/drivers/mtd/maps/Kconfig 2008-03-15 17:03:14.374622039 +0200 ++++ linux-2.6.23.16/drivers/mtd/maps/Kconfig 2008-03-15 17:03:17.874821522 +0200 +@@ -614,5 +614,30 @@ + + This selection automatically selects the map_ram driver. + ++#*************************************************************************************** ++# Storlink parallel/Serial Flash configuration ++#*************************************************************************************** ++config MTD_SL2312_CFI ++ tristate "CFI Flash device mapped on SL2312" ++ depends on MTD_CFI ++ help ++ Map driver for SL2312 demo board. ++ ++config MTD_SL2312_SERIAL_ATMEL ++ tristate "ATMEL Serial Flash device mapped on SL2312" ++ depends on MTD_PARTITIONS && ARCH_SL2312 ++ help ++ Map driver for SL2312 demo board. ++ ++config MTD_SL2312_SERIAL_ST ++ tristate "ST Serial Flash device mapped on SL2312" ++ depends on MTD_PARTITIONS && ARCH_SL2312 ++ help ++ Map driver for SL2312 demo board. ++ ++config SL2312_SHARE_PIN ++ tristate "Parallel Flash share pin on SL2312 ASIC" ++ depends on SL3516_ASIC ++ + endmenu + +Index: linux-2.6.23.16/drivers/mtd/maps/sl2312-flash-atmel.c +=================================================================== +--- /dev/null 1970-01-01 00:00:00.000000000 +0000 ++++ linux-2.6.23.16/drivers/mtd/maps/sl2312-flash-atmel.c 2008-03-15 17:04:02.877385981 +0200 +@@ -0,0 +1,554 @@ ++/* ++ * $Id: sl2312-flash-atmel.c,v 1.2 2006/06/05 02:35:57 middle Exp $ ++ * ++ * Flash and EPROM on Hitachi Solution Engine and similar boards. ++ * ++ * (C) 2001 Red Hat, Inc. ++ * ++ * GPL'd ++ */ ++ ++#include <linux/module.h> ++#include <linux/types.h> ++#include <linux/kernel.h> ++ ++#include <asm/io.h> ++#include <linux/mtd/mtd.h> ++#include <linux/mtd/map.h> ++#include <linux/mtd/partitions.h> ++#include <asm/hardware.h> ++ ++#include <asm/arch/sl2312.h> ++#include <asm/arch/flash.h> ++#include <linux/init.h> //add ++ ++ ++#define g_page_addr AT45DB321_PAGE_SHIFT //321 : shift 10 ; 642 : shift 11 ++#define g_chipen SERIAL_FLASH_CHIP0_EN //atmel ++ ++extern int parse_redboot_partitions(struct mtd_info *master, struct mtd_partition **pparts); ++ ++void address_to_page(__u32 address, __u16 *page, __u16 *offset) ++{ ++ *page = address / SPAGE_SIZE; ++ *offset = address % SPAGE_SIZE; ++} ++ ++static __u32 read_flash_ctrl_reg(__u32 ofs) ++{ ++ __u32 *base; ++ ++ base = (__u32 *)IO_ADDRESS((SL2312_FLASH_CTRL_BASE + ofs)); ++ return __raw_readl(base); ++} ++ ++static void write_flash_ctrl_reg(__u32 ofs,__u32 data) ++{ ++ __u32 *base; ++ ++ base = (__u32 *)IO_ADDRESS((SL2312_FLASH_CTRL_BASE + ofs)); ++ __raw_writel(data, base); ++} ++ ++void atmel_read_status(__u8 cmd, __u8 *data) ++{ ++ __u32 opcode; ++ __u32 value; ++ ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_OPCODE_DATA | cmd | g_chipen; ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(opcode&0x80000000) ++ { ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ ++ value=read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ *data = value & 0xff; ++} ++ ++void main_memory_page_read(__u8 cmd, __u16 page, __u16 offset, __u8 *data) ++{ ++ __u32 opcode; ++ __u32 address; ++ __u32 value; ++ ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_SHIFT_ADDRESS_4X_DATA | cmd | g_chipen; ++ address = (page << g_page_addr) + offset; ++ write_flash_ctrl_reg(FLASH_ADDRESS_OFFSET, address); ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(opcode&0x80000000) ++ { ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ ++ value=read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ *data = value & 0xff; ++} ++ ++void buffer_to_main_memory(__u8 cmd, __u16 page) ++{ ++ __u32 opcode; ++ __u32 address; ++ __u8 status; ++ ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_SHIFT_ADDRESS | cmd | g_chipen; ++ address = (page << g_page_addr); ++ write_flash_ctrl_reg(FLASH_ADDRESS_OFFSET, address); ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(opcode&0x80000000) ++ { ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ atmel_read_status(READ_STATUS_SPI, &status); ++ while(!(status&0x80)) ++ { ++ atmel_read_status(READ_STATUS_SPI, &status); ++ flash_delay(); ++ schedule(); ++ } ++ ++} ++ ++ ++void atmel_flash_read_page(__u32 address, __u8 *buffer, __u32 len) ++{ ++ __u8 byte; ++ __u16 page, offset; ++ __u16 i; ++ ++ address_to_page(address, &page, &offset); ++ ++ for(i=0; i<len; i++,offset++) ++ { ++ main_memory_page_read(MAIN_MEMORY_PAGE_READ_SPI , page, offset, &byte); ++ buffer [i]= byte; ++ } ++} ++ ++void atmel_flash_program_page(__u32 address, __u8 *buffer, __u32 len) ++{ ++ __u8 pattern; ++ __u16 page, offset; ++ __u32 i; ++ ++ address_to_page(address, &page, &offset); ++ // printk("atmel_flash_program_page: offset %x len %x page %x \n", offset, len, page); ++ ++ if(offset) ++ main_memory_to_buffer(MAIN_MEMORY_TO_BUFFER1,page); ++ ++ for(i=0; i<len; i++,offset++) ++ { ++ pattern = buffer[i]; ++ atmel_buffer_write(BUFFER1_WRITE,offset,pattern); ++ } ++ ++ // printk("atmel_flash_program_page: offset %x \n", offset); ++ buffer_to_main_memory(BUFFER1_TO_MAIN_MEMORY, page); ++ // printk("atmel_flash_program_page: buffer_to_main_memory %x page\n", page); ++ ++} ++ ++ ++void main_memory_to_buffer(__u8 cmd, __u16 page) ++{ ++ __u32 opcode; ++ __u32 address; ++ __u8 status; ++ ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_SHIFT_ADDRESS | cmd | g_chipen; ++ address = (page << g_page_addr); ++ write_flash_ctrl_reg(FLASH_ADDRESS_OFFSET, address); ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(opcode&0x80000000) ++ { ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ atmel_read_status(READ_STATUS_SPI, &status); ++ while(!(status&0x80)) ++ { ++ atmel_read_status(READ_STATUS_SPI, &status); ++ flash_delay(); ++ schedule(); ++ } ++ ++} ++ ++void main_memory_page_program(__u8 cmd, __u16 page, __u16 offset, __u8 data) ++{ ++ __u32 opcode; ++ __u32 address; ++ __u8 status; ++ ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_SHIFT_ADDRESS_DATA | cmd | g_chipen; ++ address = (page << g_page_addr) + offset; ++ write_flash_ctrl_reg(FLASH_ADDRESS_OFFSET, address); ++ write_flash_ctrl_reg(FLASH_WRITE_DATA_OFFSET, data); ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(opcode&0x80000000) ++ { ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ atmel_read_status(READ_STATUS_SPI, &status); ++ while(!(status&0x80)) ++ { ++ atmel_read_status(READ_STATUS_SPI, &status); ++ flash_delay(); ++ schedule(); ++ } ++} ++ ++void atmel_buffer_write(__u8 cmd, __u16 offset, __u8 data) ++{ ++ __u32 opcode; ++ __u32 address; ++ ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_SHIFT_ADDRESS_DATA | cmd | g_chipen; ++ address = offset; ++ write_flash_ctrl_reg(FLASH_ADDRESS_OFFSET, address); ++ write_flash_ctrl_reg(FLASH_WRITE_DATA_OFFSET, data); ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(opcode&0x80000000) ++ { ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ ++} ++ ++void atmel_erase_page(__u8 cmd, __u16 page) ++{ ++ __u32 opcode; ++ __u32 address; ++ __u8 status; ++ ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_SHIFT_ADDRESS | cmd | g_chipen; ++ address = (page << g_page_addr); ++ write_flash_ctrl_reg(FLASH_ADDRESS_OFFSET, address); ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(opcode&0x80000000) ++ { ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ atmel_read_status(READ_STATUS_SPI, &status); ++ while(!(status&0x80)) ++ { ++ atmel_read_status(READ_STATUS_SPI, &status); ++ flash_delay(); ++ schedule(); ++ } ++ ++} ++ ++void atmel_erase_block(__u8 cmd, __u16 block) ++{ ++ __u32 opcode; ++ __u32 address; ++ __u8 status; ++ ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_SHIFT_ADDRESS | cmd | g_chipen; ++ address = (block << 13); ++ write_flash_ctrl_reg(FLASH_ADDRESS_OFFSET, address); ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(opcode&0x80000000) ++ { ++ opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ atmel_read_status(READ_STATUS_SPI, &status); ++ while(!(status&0x80)) ++ { ++ atmel_read_status(READ_STATUS_SPI, &status); ++ flash_delay(); ++ schedule(); ++ } ++ ++} ++ ++void flash_delay(void) ++{ ++ int i; ++ ++ for(i=0; i<50; i++) ++ i=i; ++} ++ ++ ++ ++ ++__u32 sl2312_read32(struct map_info *map, unsigned long ofs) ++{ ++ ++#if 0 ++ __u16 page, offset; ++ __u32 pattern; ++ __u8 byte, i; ++ ++ pattern = 0; ++ address_to_page(ofs, &page, &offset); ++ for(i=0; i<4; i++, offset++) ++ { ++ pattern = pattern << 8; ++ main_memory_page_read(MAIN_MEMORY_PAGE_READ_SPI , page, offset, &byte); ++//printk("sl2312_read32:: address = %08x data = %c \n",ofs,byte); ++ pattern += byte; ++ } ++ return pattern; ++#else ++ return read_flash_ctrl_reg(ofs); ++#endif ++ ++} ++ ++__u8 sl2312_read8(struct map_info *map, unsigned long ofs) ++{ ++ __u16 page, offset; ++ __u8 byte; ++ ++ address_to_page(ofs, &page, &offset); ++ main_memory_page_read(MAIN_MEMORY_PAGE_READ_SPI , page, offset, &byte); ++ //printk("sl2312_read8:: address = %08x data = %c \n",ofs,byte); ++ return byte; ++ ++} ++ ++void sl2312_write32(struct map_info *map, __u32 d, unsigned long ofs) ++{ ++#if 0 ++ __u16 page, offset; ++ __u8 byte, i; ++ ++ address_to_page(ofs, &page, &offset); ++ for(i=0; i<4; i++, offset++) ++ { ++ byte = d & 0xff; ++ main_memory_page_program(MAIN_MEMORY_PROGRAM_BUFFER1, page, offset, byte); ++ d = d >> 8; ++//printk("sl2312_write32:: address = %08x data = %c \n",ofs,byte); ++ } ++#else ++ write_flash_ctrl_reg(ofs, d); ++#endif ++} ++ ++void sl2312_write8(struct map_info *map, __u8 d, unsigned long ofs) ++{ ++ __u16 page, offset; ++ ++ address_to_page(ofs, &page, &offset); ++ main_memory_page_program(MAIN_MEMORY_PROGRAM_BUFFER1, page, offset, d); ++//printk("sl2312_write8:: address = %08x data = %c \n",ofs,d); ++ ++} ++ ++void sl2312_copy_from(struct map_info *map, void *buf, unsigned long ofs, ssize_t len) ++{ ++ __u32 size; ++ __u8 *buffer; ++ __u32 length;//i, j, ++ ++ //printk("sl2312_copy_from:: address = %08x datalen = %d \n",ofs,len); ++ ++ length = len; ++ buffer = (__u8 *)buf; ++ while(len) ++ { ++ size = SPAGE_SIZE - (ofs%SPAGE_SIZE); ++ if(size > len) ++ size = len; ++ atmel_flash_read_page(ofs, buffer, size); ++ buffer+=size; ++ ofs+=size; ++ len -= size; ++ } ++ ++#if 0 ++ buffer = (__u8 *)buf; ++ for(i=0; i<length; i+=16) ++ { ++ for(j=0; j<16; j++,buffer++) ++ { ++ if((i*16+j)<length) ++ printk("%x ",(int)*buffer); ++ } ++ printk("\n"); ++ } ++ ++ printk("\n"); ++#endif ++ ++} ++ ++ ++void sl2312_copy_to(struct map_info *map, unsigned long ofs, void *buf, ssize_t len) ++{ ++ __u32 size; ++ __u8 *buffer; ++ ++ buffer = (__u8 *)buf; ++ //printk("sl2312_copy_to:offset %x len %x \n", ofs, len); ++// printk("sl2312_copy_to:buf is %x \n", (int)buf); ++ ++ while(len) ++ { ++ size = SPAGE_SIZE - (ofs%SPAGE_SIZE); ++ if(size > len) ++ size = len; ++ atmel_flash_program_page(ofs, buffer, size); ++ buffer+=size; ++ ofs+=size; ++ len-=size; ++ } ++ ++ ++} ++ ++ ++static struct mtd_info *serial_mtd; ++ ++static struct mtd_partition *parsed_parts; ++ ++static struct map_info sl2312_serial_map = { ++// name: "SL2312 serial flash", ++// size: 4194304, //0x400000, ++// //buswidth: 4, ++// bankwidth: 4, ++// phys: SL2312_FLASH_BASE, ++//#ifdef CONFIG_MTD_COMPLEX_MAPPINGS ++// //read32: sl2312_read32, ++// //read8: sl2312_read8, ++// copy_from: sl2312_copy_from, ++// //write8: sl2312_write8, ++// //write32: sl2312_write32, ++// read: sl2312_read32, ++// write: sl2312_write32, ++// copy_to: sl2312_copy_to ++//#endif ++ .name = "SL2312 serial flash", ++ .size = 4194304, //0x400000, ++ //buswidth: 4, ++ .bankwidth = 4, ++ .phys = SL2312_FLASH_BASE, ++#ifdef CONFIG_MTD_COMPLEX_MAPPINGS ++ //read32: sl2312_read32, ++ //read8: sl2312_read8, ++ .copy_from = sl2312_copy_from, ++ //write8: sl2312_write8, ++ //write32: sl2312_write32, ++ .read = sl2312_read32, ++ .write = sl2312_write32, ++ .copy_to = sl2312_copy_to ++#endif ++}; ++ ++ ++ ++static struct mtd_partition sl2312_partitions[] = { ++ ++ ++ ///* boot code */ ++ //{ name: "bootloader", offset: 0x00000000, size: 0x20000, }, ++ ///* kernel image */ ++ //{ name: "kerel image", offset: 0x000020000, size: 0x2E0000 }, ++ ///* All else is writable (e.g. JFFS) */ ++ //{ name: "user data", offset: 0x00300000, size: 0x00100000, }, ++ /* boot code */ ++ { .name = "bootloader", .offset = 0x00000000, .size = 0x20000, }, ++ /* kernel image */ ++ { .name = "kerel image", .offset = 0x000020000, .size = 0xE0000 }, ++ /* All else is writable (e.g. JFFS) */ ++ { .name = "user data", .offset = 0x00100000, .size = 0x00300000, }, ++ ++ ++}; ++ ++ ++ ++static int __init init_sl2312_maps(void) ++{ ++ int nr_parts = 0; ++ struct mtd_partition *parts; ++ ++ serial_mtd = kmalloc(sizeof(struct mtd_info), GFP_KERNEL); ++ if (!serial_mtd) ++ return NULL; ++ ++ memset(serial_mtd, 0, sizeof(struct mtd_info)); ++ //sl2312flash_map.virt = (unsigned long)ioremap(SL2312_FLASH_BASE, FLASH_SIZE); ++ //sl2312_serial_map.map_priv_1 = (unsigned long)ioremap(SL2312_FLASH_BASE, SFLASH_SIZE);//(unsigned long)FLASH_VBASE; ++ sl2312_serial_map.virt = (unsigned long)ioremap(SL2312_FLASH_BASE, SFLASH_SIZE);//(unsigned long)ioremap(FLASH_START, SFLASH_SIZE); ++ if (!sl2312_serial_map.virt) { ++ printk(" failed to ioremap \n"); ++ return -EIO; ++ } ++ serial_mtd = do_map_probe("map_serial", &sl2312_serial_map); ++ if (serial_mtd) { ++ //serial_mtd->module = THIS_MODULE; ++ serial_mtd->owner = THIS_MODULE; ++ ++ } ++ ++#ifdef CONFIG_MTD_REDBOOT_PARTS ++ nr_parts = parse_redboot_partitions(serial_mtd, &parsed_parts); ++ if (nr_parts > 0) ++ printk(KERN_NOTICE "Found RedBoot partition table.\n"); ++ else if (nr_parts < 0) ++ printk(KERN_NOTICE "Error looking for RedBoot partitions.\n"); ++#else ++ parsed_parts = sl2312_partitions; ++ parts = sl2312_partitions; ++ nr_parts = sizeof(sl2312_partitions)/sizeof(*parts); ++ nr_parts = sizeof(sl2312_partitions)/sizeof(*parsed_parts); ++#endif /* CONFIG_MTD_REDBOOT_PARTS */ ++ ++ if (nr_parts > 0) ++ add_mtd_partitions(serial_mtd, parsed_parts, nr_parts); ++ else ++ add_mtd_device(serial_mtd); ++ ++ return 0; ++} ++ ++static void __exit cleanup_sl2312_maps(void) ++{ ++ if (parsed_parts) ++ del_mtd_partitions(serial_mtd); ++ else ++ del_mtd_device(serial_mtd); ++ ++ map_destroy(serial_mtd); ++ ++ ++} ++ ++module_init(init_sl2312_maps); ++module_exit(cleanup_sl2312_maps); ++ ++ ++ ++MODULE_LICENSE("GPL"); ++MODULE_AUTHOR("Plus Chen <plus@storlink.com.tw>"); ++MODULE_DESCRIPTION("MTD map driver for Storlink Sword boards"); ++ +Index: linux-2.6.23.16/drivers/mtd/maps/sl2312-flash-cfi.c +=================================================================== +--- /dev/null 1970-01-01 00:00:00.000000000 +0000 ++++ linux-2.6.23.16/drivers/mtd/maps/sl2312-flash-cfi.c 2008-03-15 17:04:09.377756409 +0200 +@@ -0,0 +1,370 @@ ++/*====================================================================== ++ ++ 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 program is distributed in the hope that it will be useful, ++ but WITHOUT ANY WARRANTY; without even the implied warranty of ++ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the ++ GNU General Public License for more details. ++ ++ 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA ++======================================================================*/ ++ ++#include <linux/module.h> ++#include <linux/types.h> ++#include <linux/kernel.h> ++#include <linux/slab.h> ++#include <linux/ioport.h> ++#include <linux/init.h> ++#include <linux/string.h> ++ ++#include <linux/mtd/mtd.h> ++#include <linux/mtd/map.h> ++#include <linux/mtd/partitions.h> ++ ++#include <asm/hardware.h> ++#include <asm/io.h> ++#include <asm/system.h> ++#include <asm/arch/sl2312.h> ++#include <linux/mtd/kvctl.h> ++#include "sl2312_flashmap.h" ++ ++ ++//extern int parse_afs_partitions(struct mtd_info *, struct mtd_partition **); ++ ++/* the base address of FLASH control register */ ++#define FLASH_CONTROL_BASE_ADDR (IO_ADDRESS(SL2312_FLASH_CTRL_BASE)) ++#define SL2312_GLOBAL_BASE_ADDR (IO_ADDRESS(SL2312_GLOBAL_BASE)) ++ ++/* define read/write register utility */ ++#define FLASH_READ_REG(offset) (__raw_readl(offset+FLASH_CONTROL_BASE_ADDR)) ++#define FLASH_WRITE_REG(offset,val) (__raw_writel(val,offset+FLASH_CONTROL_BASE_ADDR)) ++ ++/* the offset of FLASH control register */ ++enum EMAC_REGISTER { ++ FLASH_ID = 0x0000, ++ FLASH_STATUS = 0x0008, ++ FLASH_TYPE = 0x000c, ++ FLASH_ACCESS = 0x0020, ++ FLASH_ADDRESS = 0x0024, ++ FLASH_DATA = 0x0028, ++ FLASH_TIMING = 0x002c, ++}; ++ ++//#define FLASH_BASE FLASH_CONTROL_BASE_ADDR ++//#define FLASH_SIZE 0x00800000 //INTEGRATOR_FLASH_SIZE ++ ++//#define FLASH_PART_SIZE 8388608 ++ ++static unsigned int flash_indirect_access = 0; ++ ++#ifdef CONFIG_SL2312_SHARE_PIN ++static unsigned int chip_en = 0x00000000; ++ ++void sl2312flash_enable_parallel_flash(void) ++{ ++ unsigned int reg_val; ++ ++ reg_val = readl(SL2312_GLOBAL_BASE_ADDR + 0x30); ++ reg_val = reg_val & 0xfffffffd; ++ writel(reg_val,SL2312_GLOBAL_BASE_ADDR + 0x30); ++ return; ++} ++ ++void sl2312flash_disable_parallel_flash(void) ++{ ++ unsigned int reg_val; ++ ++ reg_val = readl(SL2312_GLOBAL_BASE_ADDR + 0x30); ++ reg_val = reg_val | 0x00000002; ++ writel(reg_val,SL2312_GLOBAL_BASE_ADDR + 0x30); ++ return; ++} ++#endif ++ ++ ++static struct map_info sl2312flash_map = ++{ ++ name: "SL2312 CFI Flash", ++ size: FLASH_SIZE, ++ bankwidth: 2, ++ //bankwidth: 1, //for 8 bits width ++ phys: SL2312_FLASH_BASE, ++}; ++ ++static struct mtd_info *mtd; ++#if 0 ++static struct mtd_partition sl2312_partitions[] = { ++ /* boot code */ ++ { ++ name: "bootloader", ++ offset: 0x00000000, ++ size: 0x20000, ++// mask_flags: MTD_WRITEABLE, ++ }, ++ /* kernel image */ ++ { ++ name: "kerel image", ++ offset: 0x00020000, ++ size: 0x2E0000 ++ }, ++ /* All else is writable (e.g. JFFS) */ ++ { ++ name: "user data", ++ offset: 0x00300000, ++ size: 0x00100000, ++ } ++}; ++#endif ++ ++ ++ ++static int __init sl2312flash_init(void) ++{ ++ struct mtd_partition *parts; ++ int nr_parts = 0; ++ int ret; ++#ifndef CONFIG_SL2312_SHARE_PIN ++ unsigned int reg_val; ++#endif ++ ++ printk("SL2312 MTD Driver Init.......\n"); ++ ++#ifndef CONFIG_SL2312_SHARE_PIN ++ /* enable flash */ ++ reg_val = readl(SL2312_GLOBAL_BASE_ADDR + 0x30); ++ reg_val = reg_val & 0xfffffffd; ++ writel(reg_val,SL2312_GLOBAL_BASE_ADDR + 0x30); ++#else ++ sl2312flash_enable_parallel_flash(); /* enable Parallel FLASH */ ++#endif ++ FLASH_WRITE_REG(FLASH_ACCESS,0x00004000); /* parallel flash direct access mode */ ++ ret = FLASH_READ_REG(FLASH_ACCESS); ++ if (ret == 0x00004000) ++ { ++ flash_indirect_access = 0; /* parallel flash direct access */ ++ } ++ else ++ { ++ flash_indirect_access = 1; /* parallel flash indirect access */ ++ } ++ ++ /* ++ * Also, the CFI layer automatically works out what size ++ * of chips we have, and does the necessary identification ++ * for us automatically. ++ */ ++#ifdef CONFIG_GEMINI_IPI ++ sl2312flash_map.virt = FLASH_VBASE;//(unsigned int *)ioremap(SL2312_FLASH_BASE, FLASH_SIZE); ++#else ++ sl2312flash_map.virt = (unsigned int *)ioremap(SL2312_FLASH_BASE, FLASH_SIZE); ++#endif ++ //printk("sl2312flash_map.virt = %08x\n",(unsigned int)sl2312flash_map.virt); ++ ++// simple_map_init(&sl2312flash_map); ++ ++ mtd = do_map_probe("cfi_probe", &sl2312flash_map); ++ if (!mtd) ++ { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ sl2312flash_disable_parallel_flash(); /* disable Parallel FLASH */ ++#endif ++ return -ENXIO; ++ } ++ mtd->owner = THIS_MODULE; ++// mtd->erase = flash_erase; ++// mtd->read = flash_read; ++// mtd->write = flash_write; ++ ++ parts = sl2312_partitions; ++ nr_parts = sizeof(sl2312_partitions)/sizeof(*parts); ++ ret = add_mtd_partitions(mtd, parts, nr_parts); ++ /*If we got an error, free all resources.*/ ++ if (ret < 0) { ++ del_mtd_partitions(mtd); ++ map_destroy(mtd); ++ } ++#ifdef CONFIG_SL2312_SHARE_PIN ++ sl2312flash_disable_parallel_flash(); /* disable Parallel FLASH */ ++#endif ++ printk("SL2312 MTD Driver Init Success ......\n"); ++ return ret; ++} ++ ++static void __exit sl2312flash_exit(void) ++{ ++ if (mtd) { ++ del_mtd_partitions(mtd); ++ map_destroy(mtd); ++ } ++ ++ if (sl2312flash_map.virt) { ++ iounmap((void *)sl2312flash_map.virt); ++ sl2312flash_map.virt = 0; ++ } ++} ++ ++char chrtohex(char c) ++{ ++ char val; ++ if ((c >= '0') && (c <= '9')) ++ { ++ val = c - '0'; ++ return val; ++ } ++ else if ((c >= 'a') && (c <= 'f')) ++ { ++ val = 10 + (c - 'a'); ++ return val; ++ } ++ else if ((c >= 'A') && (c <= 'F')) ++ { ++ val = 10 + (c - 'A'); ++ return val; ++ } ++ printk("<1>Error number\n"); ++ return 0; ++} ++ ++ ++int get_vlaninfo(vlaninfo* vlan) ++{ ++ vctl_mheader head; ++ vctl_entry entry; ++ struct mtd_info *mymtd=NULL; ++ int i, j, loc = 0; ++ char *payload=0, *tmp1, *tmp2, tmp3[9]; ++ size_t retlen; ++ ++ #ifdef CONFIG_SL2312_SHARE_PIN ++ sl2312flash_enable_parallel_flash(); ++ #endif ++ for(i=0;i<MAX_MTD_DEVICES;i++) ++ { ++ mymtd=get_mtd_device(NULL,i); ++ // printk("mymtd->name: %s\n", mymtd->name); ++ if(mymtd && !strcmp(mymtd->name,"VCTL")) ++ { ++ // printk("%s\n", mymtd->name); ++ break; ++ } ++ } ++ if( i >= MAX_MTD_DEVICES) ++ { ++ printk("Can't find version control\n"); ++ #ifdef CONFIG_SL2312_SHARE_PIN ++ sl2312flash_disable_parallel_flash(); ++ #endif ++ return 0; ++ } ++ ++ if (!mymtd | !mymtd->read) ++ { ++ printk("<1>Can't read Version Configuration\n"); ++ #ifdef CONFIG_SL2312_SHARE_PIN ++ sl2312flash_disable_parallel_flash(); ++ #endif ++ return 0; ++ } ++ ++ mymtd->read(mymtd, 0, VCTL_HEAD_SIZE, &retlen, (u_char*)&head); ++ // printk("entry header: %c%c%c%c\n", head.header[0], head.header[1], head.header[2], head.header[3]); ++ // printk("entry number: %x\n", head.entry_num); ++ if ( strncmp(head.header, "FLFM", 4) ) ++ { ++ printk("VCTL is a erase block\n"); ++ #ifdef CONFIG_SL2312_SHARE_PIN ++ sl2312flash_disable_parallel_flash(); ++ #endif ++ return 0; ++ } ++ loc += retlen; ++ for (i = 0; i < head.entry_num; i++) ++ { ++ mymtd->read(mymtd, loc, VCTL_ENTRY_LEN, &retlen, (u_char*)&entry); ++ // printk("type: %x\n", entry.type); ++ // printk("size: %x\n", entry.size); ++ strncpy(tmp3, entry.header, 4); ++ if (entry.type == VCT_VLAN) ++ { ++ for (j = 0; j < 6 ; j++) ++ { ++ vlan[0].mac[j] = 0; ++ vlan[1].mac[j] = 0; ++ } ++ vlan[0].vlanid = 1; ++ vlan[1].vlanid = 2; ++ vlan[0].vlanmap = 0x7F; ++ vlan[1].vlanmap = 0x80; ++ ++ payload = (char *)kmalloc(entry.size - VCTL_ENTRY_LEN, GFP_KERNEL); ++ loc += VCTL_ENTRY_LEN; ++ mymtd->read(mymtd, loc, entry.size - VCTL_ENTRY_LEN, &retlen, payload); ++ // printk("%s\n", payload); ++ tmp1 = strstr(payload, "MAC1:"); ++ tmp2 = strstr(payload, "MAC2:"); ++ if(!tmp1||!tmp2){ ++ kfree(payload); ++ #ifdef CONFIG_SL2312_SHARE_PIN ++ sl2312flash_disable_parallel_flash(); ++ #endif ++ printk("Error VCTL format!!\n"); ++ return 0; ++ } ++ tmp1 += 7; ++ tmp2 += 7; ++ ++ ++ for (j = 0; j < 6; j++) ++ { ++ vlan[0].mac[j] = chrtohex(tmp1[2*j])*16 + chrtohex(tmp1[(2*j)+1]); ++ vlan[1].mac[j] = chrtohex(tmp2[2*j])*16 + chrtohex(tmp2[(2*j)+1]); ++ } ++ tmp1 = strstr(payload, "ID1:"); ++ tmp2 = strstr(payload, "ID2:"); ++ tmp1 += 4; ++ tmp2 += 4; ++ vlan[0].vlanid = tmp1[0] - '0'; ++ vlan[1].vlanid = tmp2[0] - '0'; ++ tmp1 = strstr(payload, "MAP1:"); ++ tmp2 = strstr(payload, "MAP2:"); ++ tmp1 += 7; ++ tmp2 += 7; ++ vlan[0].vlanmap = chrtohex(tmp1[0]) * 16 + chrtohex(tmp1[1]); ++ vlan[1].vlanmap = chrtohex(tmp2[0]) * 16 + chrtohex(tmp2[1]); ++ // printk("Vlan1 id:%x map:%02x mac:%x%x%x%x%x%x\n", vlan[0].vlanid, vlan[0].vlanmap, vlan[0].mac[0], vlan[0].mac[1], vlan[0].mac[2], vlan[0].mac[3], vlan[0].mac[4], vlan[0].mac[5]); ++ // printk("Vlan2 id:%x map:%02x mac:%x%x%x%x%x%x\n", vlan[1].vlanid, vlan[1].vlanmap, vlan[1].mac[0], vlan[1].mac[1], vlan[1].mac[2], vlan[1].mac[3], vlan[1].mac[4], vlan[1].mac[5]); ++ break; ++ } ++ loc += entry.size; ++ } ++ if ( entry.type == VCT_VLAN ) ++ { ++ #ifdef CONFIG_SL2312_SHARE_PIN ++ sl2312flash_disable_parallel_flash(); ++ #endif ++ kfree(payload); ++ return 1; ++ } ++ if (i >= head.entry_num) ++ printk("Can't find vlan information\n"); ++ #ifdef CONFIG_SL2312_SHARE_PIN ++ sl2312flash_disable_parallel_flash(); ++ #endif ++ return 0; ++} ++ ++EXPORT_SYMBOL(get_vlaninfo); ++ ++ ++module_init(sl2312flash_init); ++module_exit(sl2312flash_exit); ++ ++MODULE_AUTHOR("Storlink Ltd"); ++MODULE_DESCRIPTION("CFI map driver"); ++MODULE_LICENSE("GPL"); +Index: linux-2.6.23.16/drivers/mtd/maps/sl2312-flash-m25p80.c +=================================================================== +--- /dev/null 1970-01-01 00:00:00.000000000 +0000 ++++ linux-2.6.23.16/drivers/mtd/maps/sl2312-flash-m25p80.c 2008-03-15 17:04:15.378098557 +0200 +@@ -0,0 +1,498 @@ ++/* ++ * $Id: sl2312-flash-m25p80.c,v 1.2 2006/06/02 08:46:02 middle Exp $ ++ * ++ * Flash and EPROM on Hitachi Solution Engine and similar boards. ++ * ++ * (C) 2001 Red Hat, Inc. ++ * ++ * GPL'd ++ */ ++ ++#include <linux/module.h> ++#include <linux/types.h> ++#include <linux/kernel.h> ++ ++#include <asm/io.h> ++#include <linux/mtd/mtd.h> ++#include <linux/mtd/map.h> ++#include <linux/mtd/partitions.h> ++#include <asm/hardware.h> ++ ++#include <asm/arch/sl2312.h> ++#include <asm/arch/flash.h> ++#include <linux/init.h> //add ++#define g_chipen SERIAL_FLASH_CHIP0_EN //ST ++ ++//static int m25p80_page_program(__u32 address, __u8 data, __u32 schip_en); ++static void m25p80_write_cmd(__u8 cmd, __u32 schip_en); ++extern int parse_redboot_partitions(struct mtd_info *master, struct mtd_partition **pparts); ++ ++ ++static __u32 read_flash_ctrl_reg(__u32 ofs) ++{ ++ __u32 *base; ++ ++ base = (__u32 *)IO_ADDRESS((SL2312_FLASH_CTRL_BASE + ofs)); ++ return __raw_readl(base); ++} ++ ++static void write_flash_ctrl_reg(__u32 ofs,__u32 data) ++{ ++ __u32 *base; ++ ++ base = (__u32 *)IO_ADDRESS((SL2312_FLASH_CTRL_BASE + ofs)); ++ __raw_writel(data, base); ++} ++ ++static void m25p80_read(__u32 address, __u8 *data, __u32 schip_en) ++{ ++ __u32 opcode,status; ++ __u32 value; ++ ++ //opcode = 0x80000000 | FLASH_ACCESS_ACTION_OPCODE_DATA | M25P80_READ; ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_SHIFT_ADDRESS_DATA | M25P80_READ; ++ write_flash_ctrl_reg(FLASH_ADDRESS_OFFSET, address); ++ ++ opcode|=g_chipen; ++ ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ status=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(status&0x80000000) ++ { ++ status=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ ++ value=read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ *data = value & 0xff; ++} ++ ++static int m25p80_page_program(__u32 address, __u8 *data, __u32 schip_en) ++{ ++ __u32 opcode; ++ __u32 status; ++ __u32 tmp; ++ int res = FLASH_ERR_OK; ++ //volatile FLASH_DATA_T* data_ptr = (volatile FLASH_DATA_T*) data; ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_OPCODE_DATA | M25P80_READ_STATUS; ++ ++ opcode|=g_chipen; ++ ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(tmp&0x80000000) ++ { ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ //middle delay_ms(130); ++ status = read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ if((status&0x02)==0x02) ++ { ++ //middle delay_ms(100); ++ m25p80_write_cmd(M25P80_WRITE_DISABLE, schip_en); ++ } ++ ++ ++ m25p80_write_cmd(M25P80_WRITE_ENABLE, schip_en); ++ ////middle delay_ms(10); ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_SHIFT_ADDRESS_DATA | M25P80_PAGE_PROGRAM; ++ write_flash_ctrl_reg(FLASH_ADDRESS_OFFSET, address); ++ write_flash_ctrl_reg(FLASH_WRITE_DATA_OFFSET, *data); ++ ++ //status = read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ //while(status!=data) ++ //{ ++ // status = read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ // //middle delay_ms(10); ++ //} ++ ++ opcode|=g_chipen; ++ ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(tmp&0x80000000) ++ { ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ //opcode=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_OPCODE_DATA | M25P80_READ_STATUS; ++ ++ opcode|=g_chipen; ++ ++ ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(tmp&0x80000000) ++ { ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ status = read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ //while(status&0xfd) ++ while(status&0x01) ++ { ++ //if((status&0x9c)!=0) ++ // printf(" m25p80_page_program Protect Status = %x\n",status); ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(tmp&0x80000000) ++ { ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ status = read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ flash_delay(); ++ schedule(); ++ //middle delay_ms(50); ++ } ++ //printf("status = %x, data = %x\n",status,data); ++ if((status&0x02)==0x02) ++ { ++ //middle delay_ms(100); ++ m25p80_write_cmd(M25P80_WRITE_DISABLE, schip_en); ++ } ++ //};//while (len > 0) ++ return res; ++} ++ ++void m25p80_copy_from(struct map_info *map, void *buf, unsigned long ofs, ssize_t len) ++{ ++// __u32 size; ++ __u8 *buffer; ++ __u32 length;//i, j, ++ ++ length = len; ++ buffer = (__u8 *)buf; ++ while(len) ++ { ++ m25p80_read(ofs, buffer, g_chipen); ++ buffer++; ++ ofs++; ++ len --; ++ } ; ++ ++} ++ ++__u32 m25p80_read32(struct map_info *map, unsigned long ofs) ++{ ++ ++ return read_flash_ctrl_reg(ofs); ++ ++ ++} ++ ++void m25p80_write32(struct map_info *map, __u32 d, unsigned long ofs) ++{ ++ ++ write_flash_ctrl_reg(ofs, d); ++ ++} ++ ++void m25p80_copy_to(struct map_info *map, unsigned long ofs, void *buf, ssize_t len) ++{ ++ __u32 size, i, ret; ++ ++ while(len > 0) ++ { ++ if(len >= M25P80_PAGE_SIZE) ++ size = M25P80_PAGE_SIZE; ++ else ++ size = len; ++ ++ for(i=0;i<size;i++) ++ { ++ ret = m25p80_page_program( (ofs+i), (buf+i), g_chipen); ++ } ++ buf+=M25P80_PAGE_SIZE; ++ ofs+=M25P80_PAGE_SIZE; ++ len-=M25P80_PAGE_SIZE; ++ ++ }; ++ ++ ++} ++ ++static struct mtd_info *serial_mtd; ++ ++static struct mtd_partition *parsed_parts; ++ ++static struct map_info m25p80_map = { ++ ++ .name = "SL2312 serial flash m25p80", ++ .size = 1048576, //0x100000, ++ //buswidth: 4, ++ .bankwidth = 4, ++ .phys = SL2312_FLASH_BASE, ++#ifdef CONFIG_MTD_COMPLEX_MAPPINGS ++ .copy_from = m25p80_copy_from, ++ .read = m25p80_read32, ++ .write = m25p80_write32, ++ .copy_to = m25p80_copy_to ++#endif ++}; ++ ++ ++ ++static struct mtd_partition m25p80_partitions[] = { ++ ++ /* boot code */ ++ { .name = "bootloader", .offset = 0x00000000, .size = 0x20000, }, ++ /* kernel image */ ++ { .name = "kerel image", .offset = 0x000020000, .size = 0xC0000 }, ++ /* All else is writable (e.g. JFFS) */ ++ { .name = "user data", .offset = 0x000E0000, .size = 0x00010000, }, ++ ++ ++}; ++ ++void flash_delay() ++{ ++ int i,j; ++ for(i=0;i<0x100;i++) ++ j=i*3+5; ++} ++ ++int m25p80_sector_erase(__u32 address, __u32 schip_en) ++{ ++ __u32 opcode; ++ __u32 status; ++ __u32 tmp; ++ int res = FLASH_ERR_OK; ++ //printf("\n-->m25p80_sector_erase"); ++ if(address >= FLASH_START) ++ address-=FLASH_START; ++ ++ m25p80_write_cmd(M25P80_WRITE_ENABLE, schip_en); ++ //printf("\n m25p80_sector_erase : after we-en"); ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_SHIFT_ADDRESS | M25P80_SECTOR_ERASE; ++ write_flash_ctrl_reg(FLASH_ADDRESS_OFFSET, address); ++ #ifdef MIDWAY_DIAG ++ opcode|=schip_en; ++ #endif ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(tmp&0x80000000) ++ { ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_OPCODE_DATA | M25P80_READ_STATUS; ++ #ifdef MIDWAY_DIAG ++ opcode|=schip_en; ++ #endif ++ ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(tmp&0x80000000) ++ { ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ status = read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ //while(status&0xfd) ++ while(status&0x01) ++ { ++ //if((status&0x9c)!=0) ++ // printf(" m25p80_sector_erase Protect Status = %x\n",status); ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(tmp&0x80000000) ++ { ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ status = read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ flash_delay(); ++ schedule(); ++ //middle delay_ms(50); ++ } ++ if((status&0x02)==0x02) ++ { ++ //middle delay_ms(100); ++ m25p80_write_cmd(M25P80_WRITE_DISABLE, schip_en); ++ } ++ //printf("\n<--m25p80_sector_erase"); ++ return res; ++} ++ ++static void m25p80_write_cmd(__u8 cmd, __u32 schip_en) ++{ ++ __u32 opcode,tmp; ++ __u32 status; ++ ++ ++ ++ ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_OPCODE | cmd; ++ ++ opcode|=g_chipen; ++ ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(tmp&0x80000000) ++ { ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ ////// ++ opcode = 0x80000000 | FLASH_ACCESS_ACTION_OPCODE_DATA | M25P80_READ_STATUS; ++ ++ opcode|=g_chipen; ++ ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(tmp&0x80000000) ++ { ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ //middle delay_ms(130); ++ status = read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ //printf("\ncmd =%x status = %x",cmd,status); ++ if(cmd==M25P80_WRITE_ENABLE) ++ { ++ //printf("\n**-->enable** status = %x",status); ++ //middle delay_ms(100); ++ while((status&0x03) != 2) ++ { ++ //if((status&0x9c)!=0) ++ // printf(" M25P80_WRITE_ENABLE Protect Status = %x\n",status); ++ ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(tmp&0x80000000) ++ { ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ //flash_delay(); ++ } ++ status = read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ //printf("\n**enable** status = %x",status); ++ flash_delay(); ++ schedule(); ++ //middle delay_ms(100); ++ } ++ } ++ else if(cmd==M25P80_WRITE_DISABLE) ++ { ++ //while((status&0x03) == 2) ++ // printf("\n**disable** status = %x",status); ++ //middle delay_ms(100); ++ while((status&0x03) != 0) ++ { ++ //m25p80_write_status((status&0xfd),schip_en); ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(tmp&0x80000000) ++ { ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ status = read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ //printf("\n**disable** status = %x",status); ++ flash_delay(); ++ schedule(); ++ //middle delay_ms(50); ++ } ++ } ++ else ++ { ++ //while((status&0x01) !=0) ++ while((status&0x01) !=0) ++ { ++ write_flash_ctrl_reg(FLASH_ACCESS_OFFSET, opcode); ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ while(tmp&0x80000000) ++ { ++ tmp=read_flash_ctrl_reg(FLASH_ACCESS_OFFSET); ++ flash_delay(); ++ schedule(); ++ } ++ status = read_flash_ctrl_reg(FLASH_READ_DATA_OFFSET); ++ flash_delay(); ++ schedule(); ++ //middle delay_ms(50); ++ } ++ } ++ ////// ++ ++ //printf("\n<-- status = %x",status); ++} ++ ++static int __init init_sl2312_m25p80(void) ++{ ++ int nr_parts = 0; ++ struct mtd_partition *parts; ++ ++ serial_mtd = kmalloc(sizeof(struct mtd_info), GFP_KERNEL); ++ if (!serial_mtd) ++ return NULL; ++ ++ memset(serial_mtd, 0, sizeof(struct mtd_info)); ++ m25p80_map.virt = (unsigned long)ioremap(SL2312_FLASH_BASE, SFLASH_SIZE);//(unsigned long)ioremap(FLASH_START, SFLASH_SIZE); ++ if (!m25p80_map.virt) { ++ printk(" failed to ioremap \n"); ++ return -EIO; ++ } ++ serial_mtd = do_map_probe("map_serial", &m25p80_map); ++ if (serial_mtd) { ++ serial_mtd->owner = THIS_MODULE; ++ ++ } ++ ++#ifdef CONFIG_MTD_REDBOOT_PARTS ++ nr_parts = parse_redboot_partitions(serial_mtd, &parsed_parts); ++ if (nr_parts > 0) ++ printk(KERN_NOTICE "Found RedBoot partition table.\n"); ++ else if (nr_parts < 0) ++ printk(KERN_NOTICE "Error looking for RedBoot partitions.\n"); ++#else ++ parsed_parts = m25p80_partitions; ++ parts = m25p80_partitions; ++ nr_parts = sizeof(m25p80_partitions)/sizeof(*parts); ++ nr_parts = sizeof(m25p80_partitions)/sizeof(*parsed_parts); ++#endif /* CONFIG_MTD_REDBOOT_PARTS */ ++ ++ if (nr_parts > 0) ++ add_mtd_partitions(serial_mtd, parsed_parts, nr_parts); ++ else ++ add_mtd_device(serial_mtd); ++ ++ return 0; ++} ++ ++static void __exit cleanup_sl2312_m25p80(void) ++{ ++ if (parsed_parts) ++ del_mtd_partitions(serial_mtd); ++ else ++ del_mtd_device(serial_mtd); ++ ++ map_destroy(serial_mtd); ++ ++ ++} ++ ++module_init(init_sl2312_m25p80); ++module_exit(cleanup_sl2312_m25p80); ++ ++ ++ ++MODULE_LICENSE("GPL"); ++MODULE_AUTHOR("Plus Chen <plus@storlink.com.tw>"); ++MODULE_DESCRIPTION("MTD map driver for Storlink Sword boards"); ++ +Index: linux-2.6.23.16/drivers/mtd/maps/sl2312_flashmap.h +=================================================================== +--- /dev/null 1970-01-01 00:00:00.000000000 +0000 ++++ linux-2.6.23.16/drivers/mtd/maps/sl2312_flashmap.h 2008-03-15 17:03:17.874821522 +0200 +@@ -0,0 +1,21 @@ ++/* ++ * Please note that the name are used in mkflash script. Therefore ++ * don't change them. If you want to add different partitions, you ++ * will need to modify mkflash script as well so that the end image ++ * is what you include here! ++ * ++ * Also, the 7th item is always the size, so please don't add extra ++ * spaces in the name or other items. ++ * ++ * - Alan ++ */ ++ ++static struct mtd_partition sl2312_partitions[] = { ++ { name: "RedBoot", offset: 0x00000000, size: 0x00020000, }, ++ { name: "Kernel", offset: 0x00020000, size: 0x00100000, }, ++ { name: "Ramdisk", offset: 0x00120000, size: 0x00500000, }, ++ { name: "etc", offset: 0x00620000, size: 0x001A0000, }, ++ { name: "VCTL", offset: 0x007C0000, size: 0x00010000, }, ++ { name: "cfg", offset: 0x007D0000, size: 0x00020000, }, ++ { name: "FIS directory", offset: 0x007F0000, size: 0x00010000, } ++}; +Index: linux-2.6.23.16/drivers/mtd/maps/sl2312_flashmap.h.16MB +=================================================================== +--- /dev/null 1970-01-01 00:00:00.000000000 +0000 ++++ linux-2.6.23.16/drivers/mtd/maps/sl2312_flashmap.h.16MB 2008-03-15 17:03:17.874821522 +0200 +@@ -0,0 +1,21 @@ ++/* ++ * Please note that the name are used in mkflash script. Therefore ++ * don't change them. If you want to add different partitions, you ++ * will need to modify mkflash script as well so that the end image ++ * is what you include here! ++ * ++ * Also, the 7th item is always the size, so please don't add extra ++ * spaces in the name or other items. ++ * ++ * - Alan ++ */ ++ ++static struct mtd_partition sl2312_partitions[] = { ++ { name: "RedBoot", offset: 0x00000000, size: 0x00020000, }, ++ { name: "Kernel", offset: 0x00020000, size: 0x00300000, }, ++ { name: "Ramdisk", offset: 0x00320000, size: 0x00600000, }, ++ { name: "Application", offset: 0x00920000, size: 0x00600000, }, ++ { name: "VCTL", offset: 0x00F20000, size: 0x00020000, }, ++ { name: "CurConf", offset: 0x00F40000, size: 0x000A0000, }, ++ { name: "FIS directory", offset: 0x00FE0000, size: 0x00020000, } ++}; +Index: linux-2.6.23.16/drivers/mtd/maps/sl2312_flashmap.h.8MB +=================================================================== +--- /dev/null 1970-01-01 00:00:00.000000000 +0000 ++++ linux-2.6.23.16/drivers/mtd/maps/sl2312_flashmap.h.8MB 2008-03-15 17:03:17.874821522 +0200 +@@ -0,0 +1,21 @@ ++/* ++ * Please note that the name are used in mkflash script. Therefore ++ * don't change them. If you want to add different partitions, you ++ * will need to modify mkflash script as well so that the end image ++ * is what you include here! ++ * ++ * Also, the 7th item is always the size, so please don't add extra ++ * spaces in the name or other items. ++ * ++ * - Alan ++ */ ++ ++static struct mtd_partition sl2312_partitions[] = { ++ { name: "RedBoot", offset: 0x00000000, size: 0x00020000, }, ++ { name: "Kernel", offset: 0x00020000, size: 0x00200000, }, ++ { name: "Ramdisk", offset: 0x00220000, size: 0x00280000, }, ++ { name: "Application", offset: 0x004A0000, size: 0x00300000, }, ++ { name: "VCTL", offset: 0x007A0000, size: 0x00020000, }, ++ { name: "CurConf", offset: 0x007C0000, size: 0x00020000, }, ++ { name: "FIS directory", offset: 0x007E0000, size: 0x00020000, } ++}; +Index: linux-2.6.23.16/drivers/mtd/mtdchar.c +=================================================================== +--- linux-2.6.23.16.orig/drivers/mtd/mtdchar.c 2008-03-15 17:03:14.374622039 +0200 ++++ linux-2.6.23.16/drivers/mtd/mtdchar.c 2008-03-15 17:03:17.874821522 +0200 +@@ -59,6 +59,77 @@ + enum mtd_file_modes mode; + }; + ++/*********************************************************************** ++/* Storlink SoC -- flash ++/***********************************************************************/ ++#ifdef CONFIG_SL2312_SHARE_PIN ++unsigned int share_pin_flag=0; // bit0:FLASH, bit1:UART, bit2:EMAC, bit3-4:IDE ++unsigned int check_sleep_flag=0; // bit0:FLASH, bit1:IDE ++static spinlock_t sl2312_flash_lock = SPIN_LOCK_UNLOCKED; ++EXPORT_SYMBOL(share_pin_flag); ++int dbg=0; ++DECLARE_WAIT_QUEUE_HEAD(wq); ++extern struct wait_queue_head_t *flash_wait; ++unsigned int flash_req=0; ++void mtd_lock() ++{ ++ struct task_struct *tsk = current; ++ unsigned int value ; ++ unsigned long flags; ++ flash_req = 1; ++ DECLARE_WAITQUEUE(wait, tsk); ++ add_wait_queue(&wq, &wait); ++ for(;;) ++ { ++ set_task_state(tsk, TASK_INTERRUPTIBLE); ++ spin_lock_irqsave(&sl2312_flash_lock,flags); ++ if((share_pin_flag&0x1E)){//||(check_sleep_flag&0x00000002)) { ++ spin_unlock_irqrestore(&sl2312_flash_lock, flags); ++ check_sleep_flag |= 0x00000001; ++ if(dbg) ++ printk("mtd yield %x %x\n",share_pin_flag,check_sleep_flag); ++ wake_up_interruptible(&flash_wait); ++ schedule(); ++ } ++ else { ++ check_sleep_flag &= ~0x01; ++ share_pin_flag |= 0x00000001 ; // set share pin flag ++ spin_unlock_irqrestore(&sl2312_flash_lock, flags); ++ value = readl(IO_ADDRESS((SL2312_GLOBAL_BASE+GLOBAL_MISC_REG))); ++ value = value & (~PFLASH_SHARE_BIT) ; ++ writel(value,IO_ADDRESS((SL2312_GLOBAL_BASE+GLOBAL_MISC_REG))); ++ if(dbg) ++ printk("mtd Go %x %x\n",share_pin_flag,check_sleep_flag); ++ tsk->state = TASK_RUNNING; ++ remove_wait_queue(&wq, &wait); ++ return ; ++ } ++ } ++} ++ ++void mtd_unlock() ++{ ++ unsigned int value ; ++ unsigned long flags; ++ ++ spin_lock_irqsave(&sl2312_flash_lock,flags); // Disable IRQ ++ value = readl(IO_ADDRESS((SL2312_GLOBAL_BASE+GLOBAL_MISC_REG))); ++ value = value | PFLASH_SHARE_BIT ; // Disable Flash PADs ++ writel(value,IO_ADDRESS((SL2312_GLOBAL_BASE+GLOBAL_MISC_REG))); ++ share_pin_flag &= ~(0x00000001); // clear share pin flag ++ check_sleep_flag &= ~0x00000001; ++ spin_unlock_irqrestore(&sl2312_flash_lock, flags); // Restore IRQ ++ if (check_sleep_flag & 0x00000002) ++ { ++ check_sleep_flag &= ~(0x00000002); ++ wake_up_interruptible(&flash_wait); ++ } ++ DEBUG(MTD_DEBUG_LEVEL0, "Flash Unlock...\n"); ++ flash_req = 0; ++} ++#endif ++/***********************************************************************/ ++ + static loff_t mtd_lseek (struct file *file, loff_t offset, int orig) + { + struct mtd_file_info *mfi = file->private_data; +@@ -162,13 +233,21 @@ + int len; + char *kbuf; + ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_lock(); // sl2312 share pin lock ++#endif ++ + DEBUG(MTD_DEBUG_LEVEL0,"MTD_read\n"); + + if (*ppos + count > mtd->size) + count = mtd->size - *ppos; + +- if (!count) ++ if (!count){ ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return 0; ++ } + + /* FIXME: Use kiovec in 2.5 to lock down the user's buffers + and pass them directly to the MTD functions */ +@@ -178,8 +257,12 @@ + else + kbuf=kmalloc(count, GFP_KERNEL); + +- if (!kbuf) ++ if (!kbuf) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -ENOMEM; ++ } + + while (count) { + +@@ -224,6 +307,9 @@ + *ppos += retlen; + if (copy_to_user(buf, kbuf, retlen)) { + kfree(kbuf); ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; + } + else +@@ -235,13 +321,19 @@ + count = 0; + } + else { +- kfree(kbuf); ++ kfree(kbuf); ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return ret; + } + + } + + kfree(kbuf); ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return total_retlen; + } /* mtd_read */ + +@@ -255,24 +347,40 @@ + int ret=0; + int len; + ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_lock(); // sl2312 share pin lock ++#endif ++ + DEBUG(MTD_DEBUG_LEVEL0,"MTD_write\n"); + +- if (*ppos == mtd->size) ++ if (*ppos == mtd->size){ ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -ENOSPC; ++ } + + if (*ppos + count > mtd->size) + count = mtd->size - *ppos; + +- if (!count) ++ if (!count){ ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return 0; ++ } + + if (count > MAX_KMALLOC_SIZE) + kbuf=kmalloc(MAX_KMALLOC_SIZE, GFP_KERNEL); + else + kbuf=kmalloc(count, GFP_KERNEL); + +- if (!kbuf) ++ if (!kbuf) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -ENOMEM; ++ } + + while (count) { + +@@ -283,6 +391,9 @@ + + if (copy_from_user(kbuf, buf, len)) { + kfree(kbuf); ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; + } + +@@ -323,11 +434,17 @@ + } + else { + kfree(kbuf); ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return ret; + } + } + + kfree(kbuf); ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return total_retlen; + } /* mtd_write */ + +@@ -381,36 +498,67 @@ + u_long size; + struct mtd_info_user info; + ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_lock(); // sl2312 share pin lock ++#endif ++ + DEBUG(MTD_DEBUG_LEVEL0, "MTD_ioctl\n"); + + size = (cmd & IOCSIZE_MASK) >> IOCSIZE_SHIFT; + if (cmd & IOC_IN) { + if (!access_ok(VERIFY_READ, argp, size)) ++ { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; ++ } + } + if (cmd & IOC_OUT) { + if (!access_ok(VERIFY_WRITE, argp, size)) ++ { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; ++ } + } + + switch (cmd) { + case MEMGETREGIONCOUNT: + if (copy_to_user(argp, &(mtd->numeraseregions), sizeof(int))) ++ { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; ++ } + break; + + case MEMGETREGIONINFO: + { + struct region_info_user ur; + +- if (copy_from_user(&ur, argp, sizeof(struct region_info_user))) ++ if (copy_from_user(&ur, argp, sizeof(struct region_info_user))) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; ++ } + +- if (ur.regionindex >= mtd->numeraseregions) ++ if (ur.regionindex >= mtd->numeraseregions) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EINVAL; ++ } + if (copy_to_user(argp, &(mtd->eraseregions[ur.regionindex]), +- sizeof(struct mtd_erase_region_info))) ++ sizeof(struct mtd_erase_region_info))) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; ++ } + break; + } + +@@ -433,7 +581,12 @@ + struct erase_info *erase; + + if(!(file->f_mode & 2)) ++ { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EPERM; ++ } + + erase=kzalloc(sizeof(struct erase_info),GFP_KERNEL); + if (!erase) +@@ -447,6 +600,9 @@ + if (copy_from_user(&erase->addr, argp, + sizeof(struct erase_info_user))) { + kfree(erase); ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; + } + erase->mtd = mtd; +@@ -484,14 +640,26 @@ + struct mtd_oob_buf buf; + struct mtd_oob_ops ops; + +- if(!(file->f_mode & 2)) ++ if(!(file->f_mode & 2)) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EPERM; ++ } + +- if (copy_from_user(&buf, argp, sizeof(struct mtd_oob_buf))) ++ if (copy_from_user(&buf, argp, sizeof(struct mtd_oob_buf))) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; ++ } + +- if (buf.length > 4096) ++ if (buf.length > 4096) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EINVAL; ++ } + + if (!mtd->write_oob) + ret = -EOPNOTSUPP; +@@ -499,8 +667,12 @@ + ret = access_ok(VERIFY_READ, buf.ptr, + buf.length) ? 0 : EFAULT; + +- if (ret) ++ if (ret) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return ret; ++ } + + ops.ooblen = buf.length; + ops.ooboffs = buf.start & (mtd->oobsize - 1); +@@ -536,19 +708,35 @@ + struct mtd_oob_buf buf; + struct mtd_oob_ops ops; + +- if (copy_from_user(&buf, argp, sizeof(struct mtd_oob_buf))) ++ if (copy_from_user(&buf, argp, sizeof(struct mtd_oob_buf))) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; ++ } + +- if (buf.length > 4096) ++ if (buf.length > 4096) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EINVAL; ++ } + +- if (!mtd->read_oob) ++ if (!mtd->read_oob) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + ret = -EOPNOTSUPP; ++ } + else + ret = access_ok(VERIFY_WRITE, buf.ptr, + buf.length) ? 0 : -EFAULT; +- if (ret) ++ if (ret) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return ret; ++ } + + ops.ooblen = buf.length; + ops.ooboffs = buf.start & (mtd->oobsize - 1); +@@ -580,7 +768,12 @@ + struct erase_info_user info; + + if (copy_from_user(&info, argp, sizeof(info))) ++ { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; ++ } + + if (!mtd->lock) + ret = -EOPNOTSUPP; +@@ -594,7 +787,12 @@ + struct erase_info_user info; + + if (copy_from_user(&info, argp, sizeof(info))) ++ { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; ++ } + + if (!mtd->unlock) + ret = -EOPNOTSUPP; +@@ -629,11 +827,21 @@ + loff_t offs; + + if (copy_from_user(&offs, argp, sizeof(loff_t))) ++ { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; ++ } + if (!mtd->block_isbad) + ret = -EOPNOTSUPP; + else ++ { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return mtd->block_isbad(mtd, offs); ++ } + break; + } + +@@ -642,11 +850,21 @@ + loff_t offs; + + if (copy_from_user(&offs, argp, sizeof(loff_t))) ++ { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; ++ } + if (!mtd->block_markbad) + ret = -EOPNOTSUPP; + else ++ { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return mtd->block_markbad(mtd, offs); ++ } + break; + } + +@@ -654,8 +872,12 @@ + case OTPSELECT: + { + int mode; +- if (copy_from_user(&mode, argp, sizeof(int))) ++ if (copy_from_user(&mode, argp, sizeof(int))) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; ++ } + + mfi->mode = MTD_MODE_NORMAL; + +@@ -670,7 +892,12 @@ + { + struct otp_info *buf = kmalloc(4096, GFP_KERNEL); + if (!buf) ++ { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -ENOMEM; ++ } + ret = -EOPNOTSUPP; + switch (mfi->mode) { + case MTD_MODE_OTP_FACTORY: +@@ -701,12 +928,24 @@ + { + struct otp_info info; + +- if (mfi->mode != MTD_MODE_OTP_USER) ++ if (mfi->mode != MTD_MODE_OTP_USER) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EINVAL; +- if (copy_from_user(&info, argp, sizeof(info))) ++ } ++ if (copy_from_user(&info, argp, sizeof(info))) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EFAULT; +- if (!mtd->lock_user_prot_reg) ++ } ++ if (!mtd->lock_user_prot_reg) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EOPNOTSUPP; ++ } + ret = mtd->lock_user_prot_reg(mtd, info.start, info.length); + break; + } +@@ -742,8 +981,12 @@ + break; + + case MTD_MODE_RAW: +- if (!mtd->read_oob || !mtd->write_oob) ++ if (!mtd->read_oob || !mtd->write_oob) { ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif + return -EOPNOTSUPP; ++ } + mfi->mode = arg; + + case MTD_MODE_NORMAL: +@@ -766,6 +1009,10 @@ + ret = -ENOTTY; + } + ++#ifdef CONFIG_SL2312_SHARE_PIN ++ mtd_unlock(); // sl2312 share pin lock ++#endif ++ + return ret; + } /* memory_ioctl */ + +Index: linux-2.6.23.16/drivers/mtd/nand/Kconfig +=================================================================== +--- linux-2.6.23.16.orig/drivers/mtd/nand/Kconfig 2008-03-15 17:03:14.374622039 +0200 ++++ linux-2.6.23.16/drivers/mtd/nand/Kconfig 2008-03-15 17:03:17.874821522 +0200 +@@ -44,6 +44,13 @@ + This enables the driver for the autronix autcpu12 board to + access the SmartMediaCard. + ++config MTD_NAND_SL2312 ++ tristate "NAND Flash device on Storlink board" ++ depends on ARM && MTD_NAND && ARCH_SL2312 ++ help ++ This enables the driver for the Storlink board to ++ access the nand device. ++ + config MTD_NAND_EDB7312 + tristate "Support for Cirrus Logic EBD7312 evaluation board" + depends on ARCH_EDB7312 +Index: linux-2.6.23.16/drivers/mtd/nand/sl2312-flash-nand.c +=================================================================== +--- /dev/null 1970-01-01 00:00:00.000000000 +0000 ++++ linux-2.6.23.16/drivers/mtd/nand/sl2312-flash-nand.c 2008-03-15 17:03:17.874821522 +0200 +@@ -0,0 +1,2287 @@ ++/* ++ * drivers/mtd/sl2312.c ++ * ++ * $Id: sl2312-flash-nand.c,v 1.5 2006/06/15 07:02:29 middle Exp $ ++ * ++ * Copyright (C) 2001 Toshiba Corporation ++ * ++ * 2003 (c) MontaVista Software, Inc. This file is licensed under ++ * the terms of the GNU General Public License version 2. This program ++ * is licensed "as is" without any warranty of any kind, whether express ++ * or implied. ++ * ++ */ ++ ++#include <linux/slab.h> ++#include <linux/init.h> ++#include <linux/module.h> ++#include <linux/mtd/mtd.h> ++#include <linux/mtd/nand.h> ++#include <linux/mtd/nand_ecc.h> ++#include <linux/mtd/partitions.h> ++#include <linux/delay.h> ++#include <asm/io.h> ++#include <asm/hardware.h> ++#include <asm/arch/sl2312.h> ++#include "sl2312-flash-nand.h" ++ ++ ++#include <linux/errno.h> ++#include <linux/sched.h> ++#include <linux/types.h> ++#include <linux/mtd/compatmac.h> ++#include <linux/interrupt.h> ++#include <linux/bitops.h> ++ ++ ++/* ++ * NAND low-level MTD interface functions ++ */ ++static void sl2312_nand_write_buf(struct mtd_info *mtd, const u_char *buf, int len); ++static void sl2312_nand_read_buf(struct mtd_info *mtd, u_char *buf, int len); ++static int sl2312_nand_verify_buf(struct mtd_info *mtd, const u_char *buf, int len); ++ ++static int sl2312_nand_read (struct mtd_info *mtd, loff_t from, size_t len, size_t * retlen, u_char * buf); ++static int sl2312_nand_read_ecc (struct mtd_info *mtd, loff_t from, size_t len, size_t * retlen, u_char * buf, u_char * eccbuf, struct nand_oobinfo *oobsel); ++static int sl2312_nand_read_oob (struct mtd_info *mtd, loff_t from, size_t len, size_t * retlen, u_char * buf); ++static int sl2312_nand_write (struct mtd_info *mtd, loff_t to, size_t len, size_t * retlen, const u_char * buf); ++static int sl2312_nand_write_ecc (struct mtd_info *mtd, loff_t to, size_t len, ++ size_t * retlen, const u_char * buf, u_char * eccbuf, struct nand_oobinfo *oobsel); ++static int sl2312_nand_write_oob (struct mtd_info *mtd, loff_t to, size_t len, size_t * retlen, const u_char *buf); ++static int sl2312_nand_writev (struct mtd_info *mtd, const struct kvec *vecs, ++ unsigned long count, loff_t to, size_t * retlen); ++static int sl2312_nand_writev_ecc (struct mtd_info *mtd, const struct kvec *vecs, ++ unsigned long count, loff_t to, size_t * retlen, u_char *eccbuf, struct nand_oobinfo *oobsel); ++static int sl2312_nand_erase (struct mtd_info *mtd, struct erase_info *instr, int allowbbt); ++static void sl2312_nand_sync (struct mtd_info *mtd); ++static int sl2312_nand_write_page (struct mtd_info *mtd, struct nand_chip *this, int page, u_char *oob_buf, struct nand_oobinfo *oobsel); ++static int sl2312_nand_block_checkbad (struct mtd_info *mtd, loff_t ofs, int getchip, int allowbbt); ++static int sl2312_nand_erase_block(struct mtd_info *mtd, int page); ++ ++/* ++ * MTD structure for sl2312 NDFMC ++ */ ++static struct mtd_info *sl2312_mtd = NULL; ++static int nand_page=0,nand_col=0; ++ ++/* Define default oob placement schemes for large and small page devices */ ++static struct nand_oobinfo nand_oob_8 = { ++ .useecc = MTD_NANDECC_AUTOPLACE, ++ .eccbytes = 3, ++ .eccpos = {0, 1, 2}, ++ .oobfree = { {3, 2}, {6, 2} } ++}; ++ ++static struct nand_oobinfo nand_oob_16 = { ++ .useecc = MTD_NANDECC_AUTOPLACE, ++ .eccbytes = 6, ++ .eccpos = {0, 1, 2, 3, 6, 7}, ++ .oobfree = { {8, 8} } ++}; ++ ++static struct nand_oobinfo nand_oob_64 = { ++ .useecc = MTD_NANDECC_AUTOPLACE, ++ .eccbytes = 24, ++ .eccpos = { ++ 40, 41, 42, 43, 44, 45, 46, 47, ++ 48, 49, 50, 51, 52, 53, 54, 55, ++ 56, 57, 58, 59, 60, 61, 62, 63}, ++ .oobfree = { {2, 38} } ++}; ++ ++ ++/* ++ * Define partitions for flash device ++ */ ++/* the base address of FLASH control register */ ++#define FLASH_CONTROL_BASE_ADDR (IO_ADDRESS(SL2312_FLASH_CTRL_BASE)) ++#define SL2312_GLOBAL_BASE_ADDR (IO_ADDRESS(SL2312_GLOBAL_BASE)) ++//#define SL2312_FLASH_BASE_ADDR (IO_ADDRESS(SL2312_FLASH_BASE)) ++#define SL2312_FLASH_BASE_ADDR FLASH_VADDR(SL2312_FLASH_BASE) ++static unsigned int CHIP_EN; ++/* define read/write register utility */ ++//#define FLASH_READ_REG(offset) (__raw_readl(offset+FLASH_CONTROL_BASE_ADDR)) ++//#define FLASH_WRITE_REG(offset,val) (__raw_writel(val,offset+FLASH_CONTROL_BASE_ADDR)) ++//#define FLASH_READ_DATA(offset) (__raw_readb(offset+SL2312_FLASH_BASE_ADDR)) ++//#define FLASH_WRITE_DATA(offset,val) (__raw_writeb(val,offset+SL2312_FLASH_BASE_ADDR)) ++ ++unsigned int FLASH_READ_REG(unsigned int addr) ++{ ++ unsigned int *base; ++ unsigned int data; ++ ++ base = (unsigned int *)(FLASH_CONTROL_BASE_ADDR + addr); ++ data = *base; ++ return (data); ++} ++ ++void FLASH_WRITE_REG(unsigned int addr,unsigned int data) ++{ ++ unsigned int *base; ++ ++ base = (unsigned int *)(FLASH_CONTROL_BASE_ADDR + addr); ++ *base = data; ++ return; ++} ++ ++unsigned int FLASH_READ_DATA(unsigned int addr) ++{ ++ unsigned char *base; ++ unsigned int data; ++ ++ base = (unsigned char *)(SL2312_FLASH_BASE_ADDR + addr); ++ data = *base; ++ return (data); ++} ++ ++void FLASH_WRITE_DATA(unsigned int addr,unsigned int data) ++{ ++ unsigned char *base; ++ ++ base = (unsigned char *)(SL2312_FLASH_BASE_ADDR + addr); ++ *base = data; ++ return; ++} ++ ++/* the offset of FLASH control register */ ++enum NFLASH_REGISTER { ++ NFLASH_ID = 0x0000, ++ NFLASH_STATUS = 0x0008, ++ NFLASH_TYPE = 0x000c, ++ NFLASH_ACCESS = 0x0030, ++ NFLASH_COUNT = 0x0034, ++ NFLASH_CMD_ADDR = 0x0038, ++ NFLASH_ADDRESS = 0x003C, ++ NFLASH_DATA = 0x0040, ++ NFLASH_TIMING = 0x004C, ++ NFLASH_ECC_STATUS = 0x0050, ++ NFLASH_ECC_CONTROL = 0x0054, ++ NFLASH_ECC_OOB = 0x005c, ++ NFLASH_ECC_CODE_GEN0 = 0x0060, ++ NFLASH_ECC_CODE_GEN1 = 0x0064, ++ NFLASH_ECC_CODE_GEN2 = 0x0068, ++ NFLASH_ECC_CODE_GEN3 = 0x006C, ++ NFLASH_FIFO_CONTROL = 0x0070, ++ NFLASH_FIFO_STATUS = 0x0074, ++ NFLASH_FIFO_ADDRESS = 0x0078, ++ NFLASH_FIFO_DATA = 0x007c, ++}; ++ ++ ++ ++//#define FLASH_BASE FLASH_CONTROL_BASE_ADDR ++//#define FLASH_SIZE 0x00800000 //INTEGRATOR_FLASH_SIZE ++ ++//#define FLASH_PART_SIZE 8388608 ++ ++//static unsigned int flash_indirect_access = 0; ++ ++ ++#ifdef CONFIG_SL2312_SHARE_PIN ++void sl2312flash_enable_nand_flash(void) ++{ ++ unsigned int reg_val; ++ ++ reg_val = readl(SL2312_GLOBAL_BASE_ADDR + 0x30); ++ reg_val = reg_val & 0xfffffffb; ++ writel(reg_val,SL2312_GLOBAL_BASE_ADDR + 0x30); ++ return; ++} ++ ++void sl2312flash_disable_nand_flash(void) ++{ ++ unsigned int reg_val; ++ ++ reg_val = readl(SL2312_GLOBAL_BASE_ADDR + 0x30); ++ reg_val = reg_val | 0x00000004; ++ writel(reg_val,SL2312_GLOBAL_BASE_ADDR + 0x30); ++ return; ++} ++#endif ++ ++extern struct nand_oobinfo jffs2_oobinfo; ++/* ++ * Define partitions for flash devices ++ */ ++ ++static struct mtd_partition sl2312_partitions[] = { ++ { name: "RedBoot", offset: 0x00000000, size: 0x0020000, }, ++ { name: "Kernel", offset: 0x00020000, size: 0x00200000, }, ++ { name: "Ramdisk", offset: 0x00220000, size: 0x00280000, }, ++ { name: "Application", offset: 0x004A0000, size: 0x00320000, }, ++ { name: "VCTL", offset: 0x007C0000, size: 0x20000, }, ++ { name: "CurConf", offset: 0x007E0000, size: 0x20000, }, ++ { name: "FIS directory", offset: 0x007e0000, size: 0x00020000, } ++ ++}; ++ ++ ++/* ++ * hardware specific access to control-lines ++*/ ++static void sl2312_hwcontrol(struct mtd_info *mtd, int cmd) ++{ ++ ++ return ; ++} ++ ++static int sl2312_nand_scan_bbt(struct mtd_info *mtd) ++{ ++ return 0; ++} ++ ++/** ++ * nand_block_isbad - [MTD Interface] Check whether the block at the given offset is bad ++ * @mtd: MTD device structure ++ * @ofs: offset relative to mtd start ++ */ ++static int sl2312_nand_block_isbad (struct mtd_info *mtd, loff_t ofs) ++{ ++ /* Check for invalid offset */ ++ if (ofs > mtd->size) ++ return -EINVAL; ++ ++ return sl2312_nand_block_checkbad (mtd, ofs, 1, 0); ++} ++ ++/** ++ * nand_block_checkbad - [GENERIC] Check if a block is marked bad ++ * @mtd: MTD device structure ++ * @ofs: offset from device start ++ * @getchip: 0, if the chip is already selected ++ * @allowbbt: 1, if its allowed to access the bbt area ++ * ++ * Check, if the block is bad. Either by reading the bad block table or ++ * calling of the scan function. ++ */ ++ ++static int sl2312_nand_erase_block(struct mtd_info *mtd, int page) ++{ ++ int opcode; ++ /* Send commands to erase a page */ ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x00000000); //set 31b = 0 ++ ++ if(mtd->oobblock > 528) ++ FLASH_WRITE_REG(NFLASH_COUNT, 0x7f0fff21); // 3 address & 2 command ++ else ++ FLASH_WRITE_REG(NFLASH_COUNT, 0x7f0fff11); // 2 address & 2 command ++ ++ FLASH_WRITE_REG(NFLASH_CMD_ADDR, 0x0000d060); // write read id command ++ FLASH_WRITE_REG(NFLASH_ADDRESS, page); //write address 0x00 ++ ++ ++ ++ /* read maker code */ ++ opcode = 0x80003000|DWIDTH|CHIP_EN; //set start bit & 8bits write command ++ FLASH_WRITE_REG(NFLASH_ACCESS, opcode); ++ ++ while(opcode&0x80000000) //polling flash access 31b ++ { ++ opcode=FLASH_READ_REG(NFLASH_ACCESS); ++ //sl2312_flash_delay(); ++ schedule(); ++ //cond_resched(); ++ } ++} ++ ++void sl2312_flash_delay(void) ++{ ++ int i; ++ ++ for(i=0; i<50; i++) ++ i=i; ++} ++ ++static int sl2312_nand_block_checkbad (struct mtd_info *mtd, loff_t ofs, int getchip, int allowbbt) ++{ ++ struct nand_chip *this = mtd->priv; ++ ++ if (!this->bbt) ++ return this->block_bad(mtd, ofs, getchip); ++ ++ /* Return info from the table */ ++ return nand_isbad_bbt (mtd, ofs, allowbbt); ++} ++ ++/** ++ * nand_block_markbad - [MTD Interface] Mark the block at the given offset as bad ++ * @mtd: MTD device structure ++ * @ofs: offset relative to mtd start ++ */ ++static int sl2312_nand_block_markbad (struct mtd_info *mtd, loff_t ofs) ++{ ++ struct nand_chip *this = mtd->priv; ++ int ret; ++ ++ if ((ret = sl2312_nand_block_isbad(mtd, ofs))) { ++ /* If it was bad already, return success and do nothing. */ ++ if (ret > 0) ++ return 0; ++ return ret; ++ } ++ ++ return this->block_markbad(mtd, ofs); ++} ++ ++/* ++ * Get chip for selected access ++ */ ++static inline void sl2312_nand_get_chip (struct nand_chip *this, struct mtd_info *mtd, int new_state, int *erase_state) ++{ ++ ++ DECLARE_WAITQUEUE (wait, current); ++ ++ /* ++ * Grab the lock and see if the device is available ++ * For erasing, we keep the spinlock until the ++ * erase command is written. ++ */ ++retry: ++ spin_lock_bh (&this->chip_lock); ++ ++ if (this->state == FL_READY) { ++ this->state = new_state; ++ if (new_state != FL_ERASING) ++ spin_unlock_bh (&this->chip_lock); ++ return; ++ } ++ ++ if (this->state == FL_ERASING) { ++ if (new_state != FL_ERASING) { ++ this->state = new_state; ++ spin_unlock_bh (&this->chip_lock); ++ this->select_chip(mtd, 0); /* select in any case */ ++ this->cmdfunc(mtd, NAND_CMD_RESET, -1, -1); ++ return; ++ } ++ } ++ ++ set_current_state (TASK_UNINTERRUPTIBLE); ++ add_wait_queue (&this->wq, &wait); ++ spin_unlock_bh (&this->chip_lock); ++ schedule (); ++ remove_wait_queue (&this->wq, &wait); ++ goto retry; ++} ++ ++/* ++* read device ready pin ++*/ ++static int sl2312_device_ready(struct mtd_info *mtd) ++{ ++ int ready; ++ ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x00000000); //set 31b = 0 ++ FLASH_WRITE_REG(NFLASH_COUNT, 0x7f000070); //set only command no address and two data ++ ++ FLASH_WRITE_REG(NFLASH_CMD_ADDR, 0x00000070); //write read status command ++ ++ ++ ready = 0x80002000|DWIDTH|CHIP_EN; //set start bit & 8bits read command ++ FLASH_WRITE_REG(NFLASH_ACCESS, ready); ++ ++ while(ready&0x80000000) //polling flash access 31b ++ { ++ ready=FLASH_READ_REG(NFLASH_ACCESS); ++ //sl2312_flash_delay(); ++ schedule(); ++ } ++ FLASH_WRITE_REG(NFLASH_ACCESS, NFLASH_DIRECT); ++ ready=FLASH_READ_REG(NFLASH_DATA)&0xff; ++ return ready; ++} ++void sl2312_enable_hwecc(struct mtd_info *mtd, int mode) ++{ ++ /* reset first */ ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x80000001); //set 31b = 0 ++ ++} ++ ++ ++void sl2312_device_setup(void) ++{ ++ ++} ++static u_char sl2312_nand_read_byte(struct mtd_info *mtd) ++{ ++ ++ unsigned int data=0, page=0, col=0, tmp, i; ++ ++ printk ("**************************sl2312_nand_read_byte !! \n"); ++ //page = FLASH_READ_REG(NFLASH_ADDRESS)&0xffffff00; ++ //col = FLASH_READ_REG(NFLASH_ADDRESS)&0x000000ff; ++ page = nand_page; ++ col = nand_col; ++ for(i=0;i<(mtd->oobblock+mtd->oobsize);i++) ++ { ++ if(i==col) ++ data = FLASH_READ_DATA(page*mtd->oobblock +i); ++ else ++ tmp = FLASH_READ_DATA(page*mtd->oobblock +i); ++ } ++ return data&0xff; ++} ++ ++static void sl2312_nand_write_byte(struct mtd_info *mtd, u_char byte) ++{ ++ //struct nand_chip *this = mtd->priv; ++ unsigned int page=0, col=0, i; ++ u_char *databuf,oobbuf[mtd->oobsize]; ++ size_t retlen; ++ retlen=0; ++ printk ("********************sl2312_nand_write_byte !! \n"); ++ page = nand_page; ++ col = nand_col; ++ databuf = kmalloc (mtd->oobsize+mtd->oobblock,GFP_KERNEL); ++ ++ if (!databuf) { ++ printk ("sl2312_nand_write_byte : Unable to allocate SL2312 NAND MTD device structure.\n"); ++ ++ } ++ ++ for(i=0;i<(mtd->oobblock+mtd->oobsize);i++) ++ databuf[i] = FLASH_READ_DATA(page*mtd->oobblock +i); ++ ++ databuf[col] = byte; ++ sl2312_nand_write_ecc (mtd, page, mtd->oobblock, &retlen, databuf, oobbuf, NULL); ++ ++} ++ ++static void sl2312_nand_write_buf(struct mtd_info *mtd, const u_char *buf, int len) ++{ ++ int i, page=0,col=0; ++ struct nand_chip *this = mtd->priv; ++ u_char *databuf, *oobbuf; ++ size_t retlen; ++ retlen=0; ++ ++ ++ printk ("***********************sl2312_nand_write_buf !! \n"); ++ databuf = &(this->data_buf[0]); ++ oobbuf = &(this->data_buf[mtd->oobblock]); ++ for (i = 0; i < mtd->oobsize; i++) ++ oobbuf[i] = 0xff; ++ ++ if(len < mtd->oobblock) ++ { ++ //addr = FLASH_READ_REG(NFLASH_ADDRESS); ++ //page = FLASH_READ_REG(NFLASH_ADDRESS)&0xffffff00; ++ //col = FLASH_READ_REG(NFLASH_ADDRESS)&0x000000ff; ++ page = nand_page; ++ col = nand_col; ++ ++ sl2312_nand_read_ecc (mtd, page, mtd->oobblock , &retlen, databuf, oobbuf, NULL); ++ ++ for(i=col;i<len;i++) ++ databuf[col+i] = buf[i]; ++ ++ sl2312_nand_write_ecc (mtd, page, mtd->oobblock, &retlen, databuf, oobbuf, NULL); ++ ++ } ++ ++} ++ ++static void sl2312_nand_read_buf(struct mtd_info *mtd, u_char *buf, int len) ++{ ++ int i, page=0,col=0,addr=0,tmp=0; ++ //struct nand_chip *this = mtd->priv; ++ printk ("********************sl2312_nand_read_buf !! \n"); ++ if(len < mtd->oobblock) ++ { ++ //addr = FLASH_READ_REG(NFLASH_ADDRESS); ++ //page = FLASH_READ_REG(NFLASH_ADDRESS)&0xffffff00; ++ //col = FLASH_READ_REG(NFLASH_ADDRESS)&0x000000ff; ++ page = nand_page; ++ col = nand_col; ++ for (i=col; i<((mtd->oobblock+mtd->oobsize)-col); i++) ++ { ++ if(i<len) ++ buf[i] = FLASH_READ_DATA(addr+i); ++ else ++ tmp = FLASH_READ_DATA(addr+i); ++ } ++ } ++} ++ ++static int sl2312_nand_verify_buf(struct mtd_info *mtd, const u_char *buf, int len) ++{ ++ int i; ++ //struct nand_chip *this = mtd->priv; ++ u_char *datatmp, *oobtmp; ++ size_t retlen; ++ retlen=0; ++ ++ datatmp = kmalloc (mtd->oobblock,GFP_KERNEL); ++ oobtmp = kmalloc (mtd->oobsize,GFP_KERNEL); ++ ++ if ((!datatmp)||(!oobtmp)) { ++ printk ("sl2312_nand_verify_buf : Unable to allocate SL2312 NAND MTD device structure.\n"); ++ ++ } ++ //page = nand_page; ++ for(i=0;i<mtd->oobblock;i++) ++ datatmp[i] = FLASH_READ_DATA(nand_page*mtd->oobblock +i); ++ /* read oobdata */ ++ for (i = 0; i < mtd->oobsize; i++) ++ oobtmp[i] = FLASH_READ_DATA(nand_page*mtd->oobblock + mtd->oobblock + i); ++ ++ if(len==mtd->oobblock) ++ { ++ for (i=0; i<len; i++) ++ { ++ if (buf[i] != datatmp[i]) ++ { ++ kfree(datatmp); ++ kfree(oobtmp); ++ printk("Data verify error -> page: %x, byte: %x \n",nand_page,i); ++ return i; ++ } ++ } ++ } ++ else if(len == mtd->oobsize) ++ { ++ for (i=0; i<len; i++) ++ { ++ if (buf[i] != oobtmp[i]) ++ { ++ kfree(datatmp); ++ kfree(oobtmp); ++ printk("OOB verify error -> page: %x, byte: %x \n",nand_page,i); ++ return i; ++ } ++ } ++ } ++ else ++ { ++ printk (KERN_WARNING "sl2312_nand_verify_buf : verify length not match 0x%08x\n", len); ++ kfree(datatmp); ++ kfree(oobtmp); ++ return -1; ++ } ++ ++ kfree(datatmp); ++ kfree(oobtmp); ++ return 0; ++} ++ ++/* ++ * Send command to NAND device ++ */ ++static void sl2312_nand_command (struct mtd_info *mtd, unsigned command, int column, int page_addr) ++{ ++ register struct nand_chip *this = mtd->priv; ++ int opcode; ++ ++ ++ /* ++ * program and erase have their own busy handlers ++ * status and sequential in needs no delay ++ */ ++ switch (command) { ++ ++ case NAND_CMD_PAGEPROG: ++ case NAND_CMD_ERASE1: ++ case NAND_CMD_ERASE2: ++ case NAND_CMD_SEQIN: ++ case NAND_CMD_STATUS: ++ case NAND_CMD_READ0: ++ ++ /* ++ * Write out the command to the device. ++ */ ++ if (column != -1 || page_addr != -1) { ++ ++ /* Serially input address */ ++ if (column != -1) ++ //FLASH_WRITE_REG(NFLASH_ADDRESS,column); ++ nand_col=column; ++ ++ opcode = FLASH_READ_REG(NFLASH_ADDRESS); ++ ++ if (page_addr != -1) ++ //FLASH_WRITE_REG(NFLASH_ADDRESS,opcode|(page_addr<<8)); ++ nand_page = page_addr; ++ ++ } ++ return; ++ ++ case NAND_CMD_RESET: ++ if (this->dev_ready) ++ break; ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x00000000); //set 31b = 0 ++ FLASH_WRITE_REG(NFLASH_COUNT, 0x7f0fff70); //set only command and no other data ++ FLASH_WRITE_REG(NFLASH_CMD_ADDR, NAND_CMD_RESET); //write reset command ++ ++ opcode = 0x80002000|DWIDTH|CHIP_EN; //set start bit & 8bits read command ++ FLASH_WRITE_REG(NFLASH_ACCESS, opcode); ++ ++ while(opcode&0x80000000) //polling flash access 31b ++ { ++ opcode=FLASH_READ_REG(NFLASH_ACCESS); ++ //sl2312_flash_delay(); ++ schedule(); ++ } ++ while ( !(sl2312_device_ready(mtd) & 0x40)); ++ { ++ FLASH_WRITE_REG(NFLASH_ACCESS, NFLASH_DIRECT); ++ //sl2312_flash_delay(); ++ schedule(); ++ return; ++ } ++ /* This applies to read commands */ ++ default: ++ /* ++ * If we don't have access to the busy pin, we apply the given ++ * command delay ++ */ ++ if (!this->dev_ready) { ++ udelay (this->chip_delay); ++ FLASH_WRITE_REG(NFLASH_ACCESS, NFLASH_DIRECT); ++ return; ++ } ++ } ++ ++ /* wait until command is processed */ ++ while (!this->dev_ready(mtd)); ++ ++} ++/*Add function*/ ++static void nand_read_id(int chip_no, unsigned char *id) ++{ ++ unsigned int opcode, i; ++ ++ if(chip_no==0) ++ CHIP_EN = NFLASH_CHIP0_EN; ++ else ++ CHIP_EN = NFLASH_CHIP1_EN; ++ ++ opcode = FLASH_READ_REG(NFLASH_TYPE); ++ ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x00000000); //set 31b = 0 ++ if((opcode&0x00000300)<=0x00000100) ++ FLASH_WRITE_REG(NFLASH_COUNT, 0x7f000100); //set only command & address and two data ++ else ++ FLASH_WRITE_REG(NFLASH_COUNT, 0x7f000300); //set only command & address and 4 data ++ ++ FLASH_WRITE_REG(NFLASH_CMD_ADDR, 0x00000090); //write read id command ++ FLASH_WRITE_REG(NFLASH_ADDRESS, 0x00000000); //write address 0x00 ++ ++ /* read maker code */ ++ opcode = 0x80002000|DWIDTH|CHIP_EN;//|chip0_en; //set start bit & 8bits read command ++ FLASH_WRITE_REG(NFLASH_ACCESS, opcode); ++ opcode=FLASH_READ_REG(NFLASH_ACCESS); ++ while(opcode&0x80000000) //polling flash access 31b ++ { ++ opcode=FLASH_READ_REG(NFLASH_ACCESS); ++ //sl2312_flash_delay(); ++ schedule(); ++ } ++ ++ opcode = FLASH_READ_REG(NFLASH_DATA); ++ if(DWIDTH==NFLASH_WiDTH16) ++ { ++ id[0] = opcode&0xff; ++ id[1] = (opcode&0xff00)>>8; ++ } ++ else ++ { ++ id[0] = opcode&0xff; ++ opcode = 0x80002000|DWIDTH|CHIP_EN;//|chip0_en; //set start bit & 8bits read command ++ FLASH_WRITE_REG(NFLASH_ACCESS, opcode); ++ opcode=FLASH_READ_REG(NFLASH_ACCESS); ++ while(opcode&0x80000000) //polling flash access 31b ++ { ++ opcode=FLASH_READ_REG(NFLASH_ACCESS); ++ //sl2312_flash_delay(); ++ schedule(); ++ } ++ opcode = FLASH_READ_REG(NFLASH_DATA); ++ id[1] = (opcode&0xff00)>>8; ++ ++ opcode=FLASH_READ_REG(NFLASH_TYPE); ++ if((opcode&0x300)>0x100) ++ { ++ for(i=0;i<2;i++) ++ { ++ //data cycle 3 & 4 ->not use ++ opcode = 0x80002000|DWIDTH|CHIP_EN;//set start bit & 8bits read command ++ FLASH_WRITE_REG(NFLASH_ACCESS, opcode); ++ opcode=FLASH_READ_REG(NFLASH_ACCESS); ++ while(opcode&0x80000000) //polling flash access 31b ++ { ++ opcode=FLASH_READ_REG(NFLASH_ACCESS); ++ //sl2312_flash_delay(); ++ schedule(); ++ } ++ ++ opcode=FLASH_READ_REG(NFLASH_DATA); ++ id[2+i] = (opcode&(0xff0000<<i*8))>>(8*(2+i)); ++ } ++ } ++ } ++ FLASH_WRITE_REG(NFLASH_ACCESS, NFLASH_DIRECT); ++} ++ ++/* ++ * NAND erase a block ++ */ ++static int sl2312_nand_erase (struct mtd_info *mtd, struct erase_info *instr, int allowbbt) ++{ ++ int page, len, status, pages_per_block, ret, chipnr; ++ struct nand_chip *this = mtd->priv; ++ ++ DEBUG (MTD_DEBUG_LEVEL3, ++ "nand_erase: start = 0x%08x, len = %i\n", (unsigned int) instr->addr, (unsigned int) instr->len); ++ ++ /* Start address must align on block boundary */ ++ if (instr->addr & ((1 << this->phys_erase_shift) - 1)) { ++ DEBUG (MTD_DEBUG_LEVEL0, "nand_erase: Unaligned address\n"); ++ return -EINVAL; ++ } ++ ++ /* Length must align on block boundary */ ++ if (instr->len & ((1 << this->phys_erase_shift) - 1)) { ++ DEBUG (MTD_DEBUG_LEVEL0, "nand_erase: Length not block aligned\n"); ++ return -EINVAL; ++ } ++ ++ /* Do not allow erase past end of device */ ++ if ((instr->len + instr->addr) > mtd->size) { ++ DEBUG (MTD_DEBUG_LEVEL0, "nand_erase: Erase past end of device\n"); ++ return -EINVAL; ++ } ++ ++ instr->fail_addr = 0xffffffff; ++ ++ /* Grab the lock and see if the device is available */ ++ sl2312_nand_get_chip (this, mtd, FL_ERASING, NULL); ++ ++ /* Shift to get first page */ ++ page = (int) (instr->addr >> this->page_shift); ++ chipnr = (int) (instr->addr >> this->chip_shift); ++ ++ /* Calculate pages in each block */ ++ pages_per_block = 1 << (this->phys_erase_shift - this->page_shift); ++ ++ /* Select the NAND device */ ++ //this->select_chip(mtd, chipnr); ++ this->select_chip(mtd, 0); ++ ++ /* Check the WP bit */ ++ /* Check, if it is write protected */ ++ status = sl2312_device_ready(mtd); ++ if (!(status & 0x80)) { ++ DEBUG (MTD_DEBUG_LEVEL0, "nand_erase: Device is write protected!!!\n"); ++ instr->state = MTD_ERASE_FAILED; ++ goto erase_exit; ++ } ++ ++ /* Loop through the pages */ ++ len = instr->len; ++ ++ instr->state = MTD_ERASING; ++ ++ while (len) { ++ /* Check if we have a bad block, we do not erase bad blocks ! */ ++ if (this->block_bad(mtd, ((loff_t) page) << this->page_shift, 0)) { ++ printk (KERN_WARNING "nand_erase: attempt to erase a bad block at page 0x%08x\n", page); ++ //instr->state = MTD_ERASE_FAILED; ++ //goto erase_exit; ++ } ++ ++ /* Invalidate the page cache, if we erase the block which contains ++ the current cached page */ ++ if (page <= this->pagebuf && this->pagebuf < (page + pages_per_block)) ++ this->pagebuf = -1; ++ ///////// ++ ++ ///* Send commands to erase a page */ ++ //FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x00000000); //set 31b = 0 ++ // ++ //if(mtd->oobblock > 528) ++ // FLASH_WRITE_REG(NFLASH_COUNT, 0x7f0fff21); // 3 address & 2 command ++ //else ++ // FLASH_WRITE_REG(NFLASH_COUNT, 0x7f0fff11); // 2 address & 2 command ++ // ++ //FLASH_WRITE_REG(NFLASH_CMD_ADDR, 0x0000d060); // write read id command ++ //FLASH_WRITE_REG(NFLASH_ADDRESS, page); //write address 0x00 ++ // ++ // ++ // ++ ///* read maker code */ ++ //opcode = 0x80003000|DWIDTH|CHIP_EN; //set start bit & 8bits write command ++ //FLASH_WRITE_REG(NFLASH_ACCESS, opcode); ++ // ++ //while(opcode&0x80000000) //polling flash access 31b ++ //{ ++ // opcode=FLASH_READ_REG(NFLASH_ACCESS); ++ // //sl2312_flash_delay(); ++ // schedule(); ++ // //cond_resched(); ++ //} ++ sl2312_nand_erase_block(mtd, page); ++ ////////////// ++ status = this->waitfunc (mtd, this, FL_ERASING); ++ /* See if block erase succeeded */ ++ if (status & 0x01) { ++ DEBUG (MTD_DEBUG_LEVEL0, "nand_erase: " "Failed erase, page 0x%08x\n", page); ++ instr->state = MTD_ERASE_FAILED; ++ instr->fail_addr = (page << this->page_shift); ++ goto erase_exit; ++ } ++ ++ /* Increment page address and decrement length */ ++ len -= (1 << this->phys_erase_shift); ++ page += pages_per_block; ++ ++ /* Check, if we cross a chip boundary */ ++ if (len && !(page & this->pagemask)) { ++ chipnr++; ++ this->select_chip(mtd, 0); ++ this->select_chip(mtd, 0); ++ } ++ //sl2312_flash_delay(); ++ schedule(); ++ //cond_resched(); ++ } ++ instr->state = MTD_ERASE_DONE; ++ ++erase_exit: ++ /* De-select the NAND device */ ++ this->select_chip(mtd, 0); ++ spin_unlock_bh (&this->chip_lock); ++ ++ ret = instr->state == MTD_ERASE_DONE ? 0 : -EIO;; ++ /* Do call back function */ ++ if (!ret && instr->callback) ++ instr->callback (instr); ++ ++ /* The device is ready */ ++ spin_lock_bh (&this->chip_lock); ++ this->state = FL_READY; ++ spin_unlock_bh (&this->chip_lock); ++ FLASH_WRITE_REG(NFLASH_ACCESS, NFLASH_DIRECT); ++ /* Return more or less happy */ ++ return ret; ++} ++ ++static void sl2312_nand_select_chip(struct mtd_info *mtd, int chip) ++{ ++ //struct nand_chip *this = mtd->priv; ++ ++ switch(chip) { ++ case -1: ++ CHIP_EN = NFLASH_CHIP0_EN; ++ break; ++ case 0: ++ CHIP_EN = NFLASH_CHIP0_EN; ++ break; ++ case 1: ++ CHIP_EN = NFLASH_CHIP1_EN; ++ break; ++ default: ++ CHIP_EN = NFLASH_CHIP0_EN; ++ break; ++ } ++} ++ ++/** ++ * nand_default_block_markbad - [DEFAULT] mark a block bad ++ * @mtd: MTD device structure ++ * @ofs: offset from device start ++ * ++ * This is the default implementation, which can be overridden by ++ * a hardware specific driver. ++*/ ++static int sl2312_nand_default_block_markbad(struct mtd_info *mtd, loff_t ofs) ++{ ++ struct nand_chip *this = mtd->priv; ++ u_char buf[2] = {0, 0}; ++ size_t retlen; ++ int block; ++ ++ /* Get block number */ ++ block = ((int) ofs) >> this->bbt_erase_shift; ++ this->bbt[block >> 2] |= 0x01 << ((block & 0x03) << 1); ++ ++ /* Do we have a flash based bad block table ? */ ++ if (this->options & NAND_USE_FLASH_BBT) ++ return nand_update_bbt (mtd, ofs); ++ ++ /* We write two bytes, so we dont have to mess with 16 bit access */ ++ ofs += mtd->oobsize + (this->badblockpos & ~0x01); ++ return sl2312_nand_write_oob (mtd, ofs , 2, &retlen, buf); ++} ++ ++/* Appropriate chip should already be selected */ ++static int sl2312_nand_block_bad(struct mtd_info *mtd, loff_t ofs, int getchip)//(struct mtd_info *mtd, unsigned long page, ) ++{ ++ u_char *buf, *oobbuf; ++ size_t retlen; ++ unsigned long page, chipnr; ++ struct nand_chip *this = mtd->priv; ++ ++ if (getchip) { ++ page = (int)(ofs >> this->page_shift); ++ chipnr = (int)(ofs >> this->chip_shift); ++ ++ /* Grab the lock and see if the device is available */ ++ sl2312_nand_get_chip (this, mtd, FL_READING, NULL); ++ /* Select the NAND device */ ++ this->select_chip(mtd, chipnr); ++ } else ++ page = (int) ofs; ++ ++ buf = kmalloc (mtd->oobblock,GFP_KERNEL); ++ oobbuf = kmalloc (mtd->oobsize,GFP_KERNEL); ++ ++ if ((!buf)||(!oobbuf)) { ++ printk ("sl2312_nand_block_bad : Unable to allocate SL2312 NAND MTD device structure.\n"); ++ ++ } ++ ++ sl2312_nand_read_ecc (mtd, page, mtd->oobblock , &retlen, buf, oobbuf, NULL); ++ ++ ++ if(((mtd->oobblock < 528)&&(oobbuf[5] != 0xff))||((mtd->oobblock > 528)&&(oobbuf[0] != 0xff))) ++ { ++ kfree(buf); ++ kfree(oobbuf); ++ return 1; ++ } ++ ++ kfree(buf); ++ kfree(oobbuf); ++ return 0; ++} ++ ++/* ++* Use NAND read ECC ++*/ ++static int sl2312_nand_read (struct mtd_info *mtd, loff_t from, size_t len, size_t * retlen, u_char * buf) ++{ ++ return sl2312_nand_read_ecc (mtd, from, len, retlen, buf, NULL, NULL); ++} ++ ++/* ++ * NAND read with ECC ++ */ ++static int sl2312_nand_read_ecc (struct mtd_info *mtd, loff_t from, size_t len, ++ size_t * retlen, u_char * buf, u_char * oob_buf, struct nand_oobinfo *oobsel) ++{ ++ int j, col, page, opcode, i; ++ int end=0;//, ecc=0;//, end_page=0; ++ int erase_state = 0; ++ int read = 0, oob = 0, ecc_failed = 0;//, ecc_status = 0 ++ struct nand_chip *this = mtd->priv; ++ u_char *data_poi, *oob_data = oob_buf; ++ //u_char ecc_calc[6]; ++ //u_char ecc_code[6]; ++ int eccmode; ++ int *oob_config; ++ ++ ++ ++ // use chip default if zero ++ if (oobsel == NULL) ++ oobsel = &mtd->oobinfo; ++ ++ eccmode = oobsel->useecc ? this->eccmode : NAND_ECC_NONE; ++ oob_config = oobsel->eccpos; ++ ++ DEBUG (MTD_DEBUG_LEVEL3, "nand_read_ecc: from = 0x%08x, len = %i\n", (unsigned int) from, (int) len); ++ ++ /* Do not allow reads past end of device */ ++ if ((from + len) > mtd->size) { ++ DEBUG (MTD_DEBUG_LEVEL0, "nand_read_ecc: Attempt read beyond end of device\n"); ++ *retlen = 0; ++ return -EINVAL; ++ } ++ ++ /* Grab the lock and see if the device is available */ ++ sl2312_nand_get_chip (this, mtd ,FL_READING, &erase_state); ++ ++ /* Select the NAND device */ ++ this->select_chip(mtd, 0); ++ ++ /* First we calculate the starting page */ ++ page = from >> this->page_shift; ++ ++ //end_page = mtd->oobblock + mtd->oobsize; ++ end = mtd->oobblock; ++ //ecc = mtd->eccsize; ++ /* Get raw starting column */ ++ col = (from & (mtd->oobblock - 1)); ++ ++ ++ /* Send the read command */ ++ //this->cmdfunc (mtd, NAND_CMD_READ0, 0x00, page); ++ ++ /* Loop until all data read */ ++ FLASH_WRITE_REG(NFLASH_ACCESS, NFLASH_DIRECT); ++ while (read < len) { ++ ++ //udelay(1200); ++ /* If we have consequent page reads, apply delay or wait for ready/busy pin */ ++ if (read) { ++ if (!this->dev_ready) ++ udelay (this->chip_delay); ++ else ++ while (!this->dev_ready(mtd)); ++ } ++ ++ /* ++ * If the read is not page aligned, we have to read into data buffer ++ * due to ecc, else we read into return buffer direct ++ */ ++ if (!col && (len - read) >= end) ++ data_poi = &buf[read]; ++ else ++ data_poi = this->data_buf; ++ ++ /* get oob area, if we have no oob buffer from fs-driver */ ++ if (!oob_buf) { ++ oob_data = &this->data_buf[end]; ++ oob = 0; ++ } ++ ++ j = 0; ++ switch (eccmode) { ++ case NAND_ECC_NONE: { /* No ECC, Read in a page */ ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x0); //set 31b = 0 ++ break; ++ } ++ ++ case NAND_ECC_SOFT: /* Software ECC 3/256: Read in a page + oob data */ ++ break; ++ ++ case NAND_ECC_HW3_256: /* Hardware ECC 3 byte /256 byte data: Read in first 256 byte, get ecc, */ ++ break; ++ ++ case NAND_ECC_HW3_512: ++ case NAND_ECC_HW6_512: /* Hardware ECC 3/6 byte / 512 byte data : Read in a page */ ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x80000001); //set 31b = 0 ++ break; ++ ++ default: ++ printk (KERN_WARNING "Invalid NAND_ECC_MODE %d\n", this->eccmode); ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x0); ++ //BUG(); ++ }//end switch ++ ++ for(i=0;i<end;i++) ++ { ++ //udelay(7); ++ data_poi[i] = FLASH_READ_DATA(page*mtd->oobblock +i); ++ } ++ /* read oobdata */ ++ for (i = 0; i < mtd->oobsize; i++) ++ { ++ //udelay(7); ++ oob_data[oob + i] = FLASH_READ_DATA(page*mtd->oobblock +end+i); ++ } ++ ++ /* Skip ECC, if not active */ ++ if (eccmode == NAND_ECC_NONE) ++ goto readdata; ++ ++ // compare ecc and correct data ++ ++ opcode=FLASH_READ_REG(NFLASH_ECC_STATUS); ++ while(!(opcode&0x80000000)) //polling flash access 31b ++ { ++ opcode=FLASH_READ_REG(NFLASH_ECC_STATUS); ++ //sl2312_flash_delay(); ++ schedule(); ++ } ++ for(j=0;j<(end/512);j++) ++ {//for 2k page ++ ++ opcode = 0x00000000|oob_data[mtd->oobsize-3-4*j]<<16|oob_data[mtd->oobsize-2-4*j]<<8|oob_data[mtd->oobsize-1-4*j]; ++ ++ //opcode=FLASH_READ_REG(NFLASH_ECC_CODE_GEN0+(j*4)); ++ ++ FLASH_WRITE_REG(NFLASH_ECC_OOB, opcode); ++ opcode = 0x00000000|(j<<8); //select ECC code generation 0 ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, opcode); //??? ++ ++ opcode=FLASH_READ_REG(NFLASH_ECC_STATUS); ++ if((opcode&0x00000003)==0x03) ++ { ++ printk (KERN_WARNING "\nPageRead Uncorrectable error !!\n"); ++ ecc_failed++; ++ } ++ else if((opcode&0x00000003)==0x01) ++ { ++ printk (KERN_WARNING "\nPageRead One bit data error !!"); ++ // correct data ++ if((data_poi[(opcode&0xff80)>>7]>>((opcode&0x38)>>3))%1) ++ data_poi[(opcode&0xff80)>>7] &= ~(1<<((opcode&0x38)>>3)); ++ else ++ data_poi[(opcode&0xff80)>>7] |= (1<<((opcode&0x38)>>3)); ++ ++ } ++ else if((opcode&0x00000003)==0x02) ++ { ++ printk (KERN_WARNING "\nPageRead One bit ECC error !!\n"); ++ } ++ else if((opcode&0x00000003)==0x00) ++ { ++ ++ } ++ ++ }//for 2k page ++readdata: ++ if (col || (len - read) < end) { ++ for (j = col; j < end && read < len; j++) ++ buf[read++] = data_poi[j]; ++ } else ++ read += mtd->oobblock; ++ /* For subsequent reads align to page boundary. */ ++ col = 0; ++ /* Increment page address */ ++ page++; ++ schedule(); ++ } ++ /* De-select the NAND device */ ++ //this->select_chip(mtd, -1); ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x0); //set 31b = 0 ++ FLASH_WRITE_REG(NFLASH_ACCESS, NFLASH_INDIRECT); ++ /* Wake up anyone waiting on the device */ ++ spin_lock_bh (&this->chip_lock); ++ this->state = FL_READY; ++ wake_up (&this->wq); ++ spin_unlock_bh (&this->chip_lock); ++ ++ /* ++ * Return success, if no ECC failures, else -EIO ++ * fs driver will take care of that, because ++ * retlen == desired len and result == -EIO ++ */ ++ *retlen = read; ++ return ecc_failed ? -EIO : 0; ++} ++ ++/* ++ * Wait for command done. This applies to erase and program only ++ * Erase can take up to 400ms and program up to 20ms according to ++ * general NAND and SmartMedia specs ++ * ++*/ ++static int sl2312_nand_waitfunc(struct mtd_info *mtd, struct nand_chip *this, int state) ++{ ++ unsigned long timeo = jiffies; ++ int status, opcode; ++ ++ if (state == FL_ERASING) ++ timeo += (HZ * 400) / 1000; ++ else ++ timeo += (HZ * 20) / 1000; ++ ++ spin_lock_bh (&this->chip_lock); ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x00000000); //set 31b = 0 ++ FLASH_WRITE_REG(NFLASH_COUNT, 0x007f000070); //set only command no address and two data ++ ++ FLASH_WRITE_REG(NFLASH_CMD_ADDR, 0x00000070); //write read status command ++ ++ ++ opcode = 0x80002000|DWIDTH|CHIP_EN; //set start bit & 8bits read command ++ FLASH_WRITE_REG(NFLASH_ACCESS, opcode); ++ ++ while(opcode&0x80000000) //polling flash access 31b ++ { ++ opcode=FLASH_READ_REG(NFLASH_ACCESS); ++ //sl2312_flash_delay(); ++ schedule(); ++ } ++ ++ while (time_before(jiffies, timeo)) { ++ /* Check, if we were interrupted */ ++ if (this->state != state) { ++ spin_unlock_bh (&this->chip_lock); ++ FLASH_WRITE_REG(NFLASH_ACCESS, NFLASH_DIRECT); ++ return 0; ++ } ++ if (this->dev_ready) { ++ if (this->dev_ready(mtd)) ++ break; ++ } ++ if (FLASH_READ_REG(NFLASH_DATA) & 0x40) ++ break; ++ ++ spin_unlock_bh (&this->chip_lock); ++ yield (); ++ spin_lock_bh (&this->chip_lock); ++ } ++ status = FLASH_READ_REG(NFLASH_DATA)&0xff; ++ spin_unlock_bh (&this->chip_lock); ++ FLASH_WRITE_REG(NFLASH_ACCESS, NFLASH_DIRECT); ++ return status; ++} ++ ++static int sl2312_nand_read_oob (struct mtd_info *mtd, loff_t from, size_t len, size_t * retlen, u_char * buf) ++{ ++ int i, col, page, j=0; ++ //int erase_state = 0; ++ struct nand_chip *this = mtd->priv; ++ u_char *databuf, *oobbuf; ++ ++ databuf = &this->data_buf[0]; ++ oobbuf = &this->data_buf[mtd->oobblock]; ++ for (i = 0; i < mtd->oobsize; i++) ++ oobbuf[i] = 0xff; ++ ++ DEBUG (MTD_DEBUG_LEVEL3, "nand_read_oob: from = 0x%08x, len = %i\n", (unsigned int) from, (int) len); ++ ++ /* Shift to get page */ ++ page = ((int) from) >> this->page_shift; ++ ++ /* Mask to get column */ ++ col = from & (mtd->oobsize-1); //0x0f; ++ ++ /* Initialize return length value */ ++ *retlen = 0; ++ sl2312_nand_read_ecc (mtd, page, mtd->oobblock , retlen, databuf, oobbuf, NULL); ++ for(i=col,j=0;i<mtd->oobsize||i<(col+len);i++,j++) ++ buf[j] = oobbuf[i]; ++ ++ *retlen = j ; ++ return 0; ++} ++ ++#define NOTALIGNED(x) (x & (mtd->oobblock-1)) != 0 ++/* ++* Use NAND write ECC ++*/ ++static int sl2312_nand_write (struct mtd_info *mtd, loff_t to, size_t len, size_t * retlen, const u_char * buf) ++{ ++ return (sl2312_nand_write_ecc (mtd, to, len, retlen, buf, NULL, NULL)); ++} ++ ++/* ++ * NAND write with ECC ++ */ ++static int sl2312_nand_write_ecc (struct mtd_info *mtd, loff_t to, size_t len, ++ size_t * retlen, const u_char * buf, u_char * eccbuf, struct nand_oobinfo *oobsel) ++{ ++ int page, ret = 0, oob = 0, written = 0; ++ struct nand_chip *this = mtd->priv; ++ ++ DEBUG (MTD_DEBUG_LEVEL3, "nand_write_ecc: to = 0x%08x, len = %i\n", (unsigned int) to, (int) len); ++ ++ ++ /* Do not allow write past end of device */ ++ if ((to + len) > mtd->size) { ++ DEBUG (MTD_DEBUG_LEVEL0, "nand_write_ecc: Attempt to write past end of page\n"); ++ return -EINVAL; ++ } ++ ++ /* reject writes, which are not page aligned */ ++ if (NOTALIGNED (to) || NOTALIGNED(len)) { ++ printk (KERN_NOTICE "nand_write_ecc: Attempt to write not page aligned data\n"); ++ return -EINVAL; ++ } ++ ++ // if oobsel is NULL, use chip defaults ++ if (oobsel == NULL) ++ oobsel = &mtd->oobinfo; ++ ++ /* Shift to get page */ ++ page = ((int) to) >> this->page_shift; ++ ++ /* Grab the lock and see if the device is available */ ++ sl2312_nand_get_chip (this, mtd, FL_WRITING, NULL); ++ ++ /* Select the NAND device */ ++ this->select_chip(mtd, 0); ++ ++ /* Check the WP bit */ ++ if (!(sl2312_device_ready(mtd) & 0x80)) { ++ DEBUG (MTD_DEBUG_LEVEL0, "nand_write_ecc: Device is write protected!!!\n"); ++ ret = -EIO; ++ goto out; ++ } ++ ++ /* Loop until all data is written */ ++ while (written < len) { ++ //udelay(100); ++ int cnt = mtd->oobblock; ++ this->data_poi = (u_char*) &buf[written]; ++ /* We use the same function for write and writev */ ++ if (eccbuf) { ++ ret = sl2312_nand_write_page (mtd, this, page, &eccbuf[oob], oobsel); ++ oob += mtd->oobsize; ++ } else ++ ret = sl2312_nand_write_page (mtd, this, page, NULL, oobsel); ++ ++ if (ret) ++ goto out; ++ ++ /* Update written bytes count */ ++ written += cnt; ++ /* Increment page address */ ++ page++; ++ } ++ ++out: ++ /* De-select the NAND device */ ++ //this->select_chip(mtd, -1); ++ ++ /* Wake up anyone waiting on the device */ ++ spin_lock_bh (&this->chip_lock); ++ this->state = FL_READY; ++ wake_up (&this->wq); ++ spin_unlock_bh (&this->chip_lock); ++ ++ *retlen = written; ++ return ret; ++} ++ ++/* ++ * Nand_page_program function is used for write and writev ! ++ * This function will always program a full page of data ++ * If you call it with a non page aligned buffer, you're lost :) ++ */ ++static int sl2312_nand_write_page (struct mtd_info *mtd, struct nand_chip *this, int page, u_char *oob_buf, struct nand_oobinfo *oobsel) ++{ ++ int i, j, status, opcode; ++ u_char ecc_code[16], *oob_data; ++ int eccmode = oobsel->useecc ? this->eccmode : NAND_ECC_NONE; ++ //int *oob_config = oobsel->eccpos; ++ ++ /* pad oob area, if we have no oob buffer from fs-driver */ ++ if (!oob_buf) { ++ oob_data = &this->data_buf[mtd->oobblock]; ++ for (i = 0; i < mtd->oobsize; i++) ++ oob_data[i] = 0xff; ++ } else ++ oob_data = oob_buf; ++ ++ /* Send command to begin auto page programming */ ++ ++ memset(oob_data,0xff,mtd->oobsize); ++ /* Write out complete page of data, take care of eccmode */ ++ switch (eccmode) { ++ /* No ecc and software ecc 3/256, write all */ ++ case NAND_ECC_NONE: ++ printk (KERN_WARNING "Writing data without ECC to NAND-FLASH is not recommended\n"); ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x0); //set 31b = 0 ++ break; ++ case NAND_ECC_SOFT: ++ break; ++ ++ /* Hardware ecc 3 byte / 256 data, write first half, get ecc, then second, if 512 byte pagesize */ ++ case NAND_ECC_HW3_256: ++ break; ++ ++ /* Hardware ecc 3 byte / 512 byte data, write full page */ ++ case NAND_ECC_HW3_512: ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x80000001); //set 31b = 0 ++ ++ /* Hardware ecc 6 byte / 512 byte data, write full page */ ++ case NAND_ECC_HW6_512: ++ break; ++ ++ default: ++ printk (KERN_WARNING "Invalid NAND_ECC_MODE %d\n", this->eccmode); ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x0); //set 31b = 0 ++ //BUG(); ++ } ++ ++ FLASH_WRITE_REG(NFLASH_ACCESS, NFLASH_DIRECT); ++ ++ for(i=0;i<mtd->oobblock;i++) ++ { ++ //udelay(5); ++ FLASH_WRITE_DATA((page*mtd->oobblock)+i,this->data_poi[i]); ++ } ++ /////////////// ++ if(eccmode!=NAND_ECC_NONE) ++ { ++ opcode=FLASH_READ_REG(NFLASH_ECC_STATUS); ++ while(!(opcode&0x80000000)) //polling flash access 31b ++ { ++ opcode=FLASH_READ_REG(NFLASH_ECC_STATUS); ++ //sl2312_flash_delay(); ++ schedule(); ++ } ++ ++ ++ for(i=0;i<(mtd->oobblock/512);i++) ++ { ++ opcode=FLASH_READ_REG(NFLASH_ECC_CODE_GEN0+(i*4)); ++ ++ for(j=3;j>0;j--) ++ oob_data[(mtd->oobsize-j-(i*4))] = (opcode<<((4-j)*8)) >>24; ++ ++ for(j=0;j<4;j++) ++ { ++ ecc_code[15-i*4] = opcode; ++ ecc_code[15-i*4-1] = opcode>>8; ++ ecc_code[15-i*4-2] = opcode>>16; ++ } ++ } ++ ++ //disable ecc ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x00000000); ++ ++ /* Write out OOB data */ ++ for(i=0;i<mtd->oobsize;i++) ++ { ++ //udelay(5); ++ FLASH_WRITE_DATA((page*mtd->oobblock)+mtd->oobblock+i,oob_data[i]); ++ } ++ } ++ else ++ { ++ for(i=0;i<mtd->oobsize;i++) ++ { ++ //udelay(5); ++ FLASH_WRITE_DATA((page*mtd->oobblock)+mtd->oobblock+i,0xff); ++ } ++ } ++ ++ ++ /* call wait ready function */ ++ status = this->waitfunc (mtd, this, FL_WRITING); ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x0); //set 31b = 0 ++ /* See if device thinks it succeeded */ ++ if (status & 0x01) { ++ DEBUG (MTD_DEBUG_LEVEL0, "%s: " "Failed write, page 0x%08x, ", __FUNCTION__, page); ++ FLASH_WRITE_REG(NFLASH_ECC_CONTROL, 0x0); //set 31b = 0 ++ return -EIO; ++ } ++ ++#ifdef CONFIG_MTD_NAND_VERIFY_WRITE ++ /* ++ * The NAND device assumes that it is always writing to ++ * a cleanly erased page. Hence, it performs its internal ++ * write verification only on bits that transitioned from ++ * 1 to 0. The device does NOT verify the whole page on a ++ * byte by byte basis. It is possible that the page was ++ * not completely erased or the page is becoming unusable ++ * due to wear. The read with ECC would catch the error ++ * later when the ECC page check fails, but we would rather ++ * catch it early in the page write stage. Better to write ++ * no data than invalid data. ++ */ ++ ++ /* Send command to read back the page */ ++ this->cmdfunc (mtd, NAND_CMD_READ0, 0, page); ++ /* Loop through and verify the data */ ++ if (this->verify_buf(mtd, this->data_poi, mtd->oobblock)) { ++ DEBUG (MTD_DEBUG_LEVEL0, "%s: " "Failed write verify, page 0x%08x ", __FUNCTION__, page); ++ return -EIO; ++ } ++ ++ /* check, if we have a fs-supplied oob-buffer */ ++ if (oob_buf) { ++ if (this->verify_buf(mtd, oob_data, mtd->oobsize)) { ++ DEBUG (MTD_DEBUG_LEVEL0, "%s: " "Failed write verify, page 0x%08x ", __FUNCTION__, page); ++ return -EIO; ++ } ++ } else { ++ if (eccmode != NAND_ECC_NONE) { ++ int ecc_bytes = 0; ++ ++ switch (this->eccmode) { ++ case NAND_ECC_SOFT: ++ case NAND_ECC_HW3_256: ecc_bytes = (mtd->oobblock == 512) ? 6 : 3; break; ++ case NAND_ECC_HW3_512: ecc_bytes = 3; break; ++ case NAND_ECC_HW6_512: ecc_bytes = 6; break; ++ } ++ ++ ++ ++ for(i=0;i < (mtd->oobblock+mtd->oobsize);i++) ++ { ++ if(i>=mtd->oobblock) ++ oob_data[i-mtd->oobblock] = FLASH_READ_DATA((page*mtd->oobblock) +i); ++ else ++ oob_data[0] = FLASH_READ_DATA((page*mtd->oobblock) +i); ++ } ++ ++ if(this->eccmode == NAND_ECC_HW3_512) ++ { ++ for(i=0;i<(mtd->oobblock/512);i++) ++ { ++ for(j=0;j<3;j++) ++ { ++ if (oob_data[mtd->oobsize-1-j-4*i] != ecc_code[15-j-4*i]) { ++ DEBUG (MTD_DEBUG_LEVEL0, ++ "%s: Failed ECC write " ++ "verify, page 0x%08x, " "%6i bytes were succesful\n", __FUNCTION__, page, i); ++ return -EIO; ++ } ++ } ++ } ++ } ++ }//eccmode != NAND_ECC_NONE ++ } ++ /* ++ * Terminate the read command. This is faster than sending a reset command or ++ * applying a 20us delay before issuing the next programm sequence. ++ * This is not a problem for all chips, but I have found a bunch of them. ++ */ ++ //this->select_chip(mtd, -1); ++ //this->select_chip(mtd, 0); ++#endif ++ ++ return 0; ++} ++ ++/* ++ * NAND write with iovec ++ */ ++static int sl2312_nand_writev (struct mtd_info *mtd, const struct kvec *vecs, unsigned long count, ++ loff_t to, size_t * retlen) ++{ ++ return (sl2312_nand_writev_ecc (mtd, vecs, count, to, retlen, NULL, 0)); ++} ++ ++static int sl2312_nand_writev_ecc (struct mtd_info *mtd, const struct kvec *vecs, unsigned long count, ++ loff_t to, size_t * retlen, u_char *eccbuf, struct nand_oobinfo *oobsel) ++{ ++ int i, page, len, total_len, ret = 0, written = 0; ++ struct nand_chip *this = mtd->priv; ++ ++ /* Calculate total length of data */ ++ total_len = 0; ++ for (i = 0; i < count; i++) ++ total_len += (int) vecs[i].iov_len; ++ ++ DEBUG (MTD_DEBUG_LEVEL3, ++ "nand_writev: to = 0x%08x, len = %i, count = %ld\n", (unsigned int) to, (unsigned int) total_len, count); ++ ++ /* Do not allow write past end of page */ ++ if ((to + total_len) > mtd->size) { ++ DEBUG (MTD_DEBUG_LEVEL0, "nand_writev: Attempted write past end of device\n"); ++ return -EINVAL; ++ } ++ ++ /* reject writes, which are not page aligned */ ++ if (NOTALIGNED (to) || NOTALIGNED(total_len)) { ++ printk (KERN_NOTICE "nand_write_ecc: Attempt to write not page aligned data\n"); ++ return -EINVAL; ++ } ++ ++ // if oobsel is NULL, use chip defaults ++ if (oobsel == NULL) ++ oobsel = &mtd->oobinfo; ++ ++ /* Shift to get page */ ++ page = ((int) to) >> this->page_shift; ++ ++ /* Grab the lock and see if the device is available */ ++ sl2312_nand_get_chip (this, mtd, FL_WRITING, NULL); ++ ++ /* Select the NAND device */ ++ this->select_chip(mtd, 0); ++ ++ /* Check the WP bit */ ++ if (!(sl2312_device_ready(mtd) & 0x80)) { ++ DEBUG (MTD_DEBUG_LEVEL0, "sl2312_nand_writev_ecc: Device is write protected!!!\n"); ++ ret = -EIO; ++ goto out; ++ } ++ ++ /* Loop until all iovecs' data has been written */ ++ len = 0; ++ while (count) { ++ /* ++ * Check, if the tuple gives us not enough data for a ++ * full page write. Then we can use the iov direct, ++ * else we have to copy into data_buf. ++ */ ++ if ((vecs->iov_len - len) >= mtd->oobblock) { ++ this->data_poi = (u_char *) vecs->iov_base; ++ this->data_poi += len; ++ len += mtd->oobblock; ++ /* Check, if we have to switch to the next tuple */ ++ if (len >= (int) vecs->iov_len) { ++ vecs++; ++ len = 0; ++ count--; ++ } ++ } else { ++ /* ++ * Read data out of each tuple until we have a full page ++ * to write or we've read all the tuples. ++ */ ++ int cnt = 0; ++ while ((cnt < mtd->oobblock) && count) { ++ if (vecs->iov_base != NULL && vecs->iov_len) { ++ this->data_buf[cnt++] = ((u_char *) vecs->iov_base)[len++]; ++ } ++ /* Check, if we have to switch to the next tuple */ ++ if (len >= (int) vecs->iov_len) { ++ vecs++; ++ len = 0; ++ count--; ++ } ++ } ++ this->data_poi = this->data_buf; ++ } ++ ++ /* We use the same function for write and writev !) */ ++ ret = sl2312_nand_write_page (mtd, this, page, NULL, oobsel); ++ if (ret) ++ goto out; ++ ++ /* Update written bytes count */ ++ written += mtd->oobblock;; ++ ++ /* Increment page address */ ++ page++; ++ } ++ ++out: ++ /* De-select the NAND device */ ++ //this->select_chip(mtd, -1); ++ ++ /* Wake up anyone waiting on the device */ ++ spin_lock_bh (&this->chip_lock); ++ this->state = FL_READY; ++ wake_up (&this->wq); ++ spin_unlock_bh (&this->chip_lock); ++ ++ *retlen = written; ++ return ret; ++} ++ ++/* ++static u_char ffchars[] = { ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, ++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff ++}; ++*/ ++/* ++ * NAND write out-of-band ++ */ ++static int sl2312_nand_write_oob (struct mtd_info *mtd, loff_t to, size_t len, size_t * retlen, const u_char * buf) ++{ ++ int column, page, status, ret = 0, j=0; ++ struct nand_chip *this = mtd->priv; ++ u_char *databuf, *oobbuf; ++ ++ ++ databuf = &this->data_buf[0]; ++ oobbuf = &this->data_buf[mtd->oobblock]; ++ for (j = 0; j < mtd->oobsize; j++) ++ oobbuf[j] = 0xff; ++//#ifdef CONFIG_MTD_NAND_VERIFY_WRITE ++// int i; ++//#endif ++ ++ DEBUG (MTD_DEBUG_LEVEL3, "nand_write_oob: to = 0x%08x, len = %i\n", (unsigned int) to, (int) len); ++ ++ /* Shift to get page */ ++ page = ((int) to) >> this->page_shift; ++ ++ /* Mask to get column */ ++ column = to & 0x1f; ++ ++ /* Initialize return length value */ ++ *retlen = 0; ++ ++ /* Do not allow write past end of page */ ++ if ((column + len) > mtd->oobsize) { ++ DEBUG (MTD_DEBUG_LEVEL0, "nand_write_oob: Attempt to write past end of page\n"); ++ return -EINVAL; ++ } ++ ++ /* Grab the lock and see if the device is available */ ++ sl2312_nand_get_chip (this, mtd, FL_WRITING, NULL); ++ ++ /* Select the NAND device */ ++ this->select_chip(mtd, 0); ++ ++ /* Reset the chip. Some chips (like the Toshiba TC5832DC found ++ in one of my DiskOnChip 2000 test units) will clear the whole ++ data page too if we don't do this. I have no clue why, but ++ I seem to have 'fixed' it in the doc2000 driver in ++ August 1999. dwmw2. */ ++ this->cmdfunc(mtd, NAND_CMD_RESET, -1, -1); ++ ++ /* Check the WP bit */ ++ if (!(sl2312_device_ready(mtd) & 0x80)) { ++ DEBUG (MTD_DEBUG_LEVEL0, "nand_write_oob: Device is write protected!!!\n"); ++ ret = -EIO; ++ goto out; ++ } ++ /* Write out desired data */ ++ this->cmdfunc (mtd, NAND_CMD_SEQIN, mtd->oobblock, page); ++ ++ sl2312_nand_read_ecc (mtd, page, mtd->oobblock , retlen, databuf, oobbuf, NULL); ++ ++ for(j=column;j<(column+len);j++) ++ oobbuf[j] = buf[j-column]; ++ sl2312_nand_write_ecc (mtd, page, mtd->oobblock, retlen, databuf, oobbuf, NULL); ++ ++ status = this->waitfunc (mtd, this, FL_WRITING); ++ ++ /* See if device thinks it succeeded */ ++ if (status & 0x01) { ++ DEBUG (MTD_DEBUG_LEVEL0, "nand_write_oob: " "Failed write, page 0x%08x\n", page); ++ ret = -EIO; ++ goto out; ++ } ++ /* Return happy */ ++ *retlen = len; ++ ++ ++out: ++ /* De-select the NAND device */ ++ //this->select_chip(mtd, -1); ++ ++ /* Wake up anyone waiting on the device */ ++ spin_lock_bh (&this->chip_lock); ++ this->state = FL_READY; ++ wake_up (&this->wq); ++ spin_unlock_bh (&this->chip_lock); ++ ++ return ret; ++} ++ ++/* ++ * NAND sync ++ */ ++static void sl2312_nand_sync (struct mtd_info *mtd) ++{ ++ struct nand_chip *this = mtd->priv; ++ DECLARE_WAITQUEUE (wait, current); ++ ++ DEBUG (MTD_DEBUG_LEVEL3, "nand_sync: called\n"); ++ ++retry: ++ /* Grab the spinlock */ ++ spin_lock_bh (&this->chip_lock); ++ ++ /* See what's going on */ ++ switch (this->state) { ++ case FL_READY: ++ case FL_SYNCING: ++ this->state = FL_SYNCING; ++ spin_unlock_bh (&this->chip_lock); ++ break; ++ ++ default: ++ /* Not an idle state */ ++ add_wait_queue (&this->wq, &wait); ++ spin_unlock_bh (&this->chip_lock); ++ schedule (); ++ ++ remove_wait_queue (&this->wq, &wait); ++ goto retry; ++ } ++ ++ /* Lock the device */ ++ spin_lock_bh (&this->chip_lock); ++ ++ /* Set the device to be ready again */ ++ if (this->state == FL_SYNCING) { ++ this->state = FL_READY; ++ wake_up (&this->wq); ++ } ++ ++ /* Unlock the device */ ++ spin_unlock_bh (&this->chip_lock); ++} ++ ++ ++/* ++ * Scan for the NAND device ++ */ ++int sl2312_nand_scan (struct mtd_info *mtd, int maxchips) ++{ ++ int i, j, nand_maf_id, nand_dev_id, busw; ++ struct nand_chip *this = mtd->priv; ++ unsigned char id[4]; ++ ++ /* Get buswidth to select the correct functions*/ ++ busw = this->options & NAND_BUSWIDTH_16; ++ ++ /* check for proper chip_delay setup, set 20us if not */ ++ if (!this->chip_delay) ++ this->chip_delay = 20; ++ ++ /* check, if a user supplied command function given */ ++ if (this->cmdfunc == NULL) ++ this->cmdfunc = sl2312_nand_command; ++ ++ /* check, if a user supplied wait function given */ ++ if (this->waitfunc == NULL) ++ this->waitfunc = sl2312_nand_waitfunc; ++ ++ if (!this->select_chip) ++ this->select_chip = sl2312_nand_select_chip; ++ if (!this->write_byte) ++ this->write_byte = sl2312_nand_write_byte; //busw ? nand_write_byte16 : nand_write_byte; ++ if (!this->read_byte) ++ this->read_byte = sl2312_nand_read_byte; //busw ? nand_read_byte16 : nand_read_byte; ++// if (!this->write_word) ++// this->write_word = nand_write_word; ++// if (!this->read_word) ++// this->read_word = nand_read_word; ++// if (!this->block_bad) ++ this->block_bad = sl2312_nand_block_bad; //nand_block_bad; ++ if (!this->block_markbad) ++ this->block_markbad = sl2312_nand_default_block_markbad; ++ if (!this->write_buf) ++ this->write_buf = sl2312_nand_write_buf; //busw ? nand_write_buf16 : nand_write_buf; ++ if (!this->read_buf) ++ this->read_buf = sl2312_nand_read_buf; //busw ? nand_read_buf16 : nand_read_buf; ++ if (!this->verify_buf) ++ this->verify_buf = sl2312_nand_verify_buf; //busw ? nand_verify_buf16 : nand_verify_buf; ++ if (!this->scan_bbt) ++ this->scan_bbt = sl2312_nand_scan_bbt; ++ ++ /* Select the device */ ++ this->select_chip(mtd, 0); ++ ++ /* Read manufacturer and device IDs */ ++ nand_read_id(0,id); ++ ++ nand_maf_id = id[0]; ++ nand_dev_id = id[1]; ++ ++ /* Print and store flash device information */ ++ for (i = 0; nand_flash_ids[i].name != NULL; i++) { ++ ++ if (nand_dev_id != nand_flash_ids[i].id) ++ continue; ++ ++ if (!mtd->name) mtd->name = nand_flash_ids[i].name; ++ this->chipsize = nand_flash_ids[i].chipsize << 20; ++ ++ /* New devices have all the information in additional id bytes */ ++ if (!nand_flash_ids[i].pagesize) { ++ int extid; ++ ++ /* The 4th id byte is the important one */ ++ extid = id[3]; ++ /* Calc pagesize */ ++ mtd->oobblock = 1024 << (extid & 0x3); ++ extid >>= 2; ++ /* Calc oobsize */ ++ mtd->oobsize = (8 << (extid & 0x03)) * (mtd->oobblock / 512); ++ extid >>= 2; ++ /* Calc blocksize. Blocksize is multiples of 64KiB */ ++ mtd->erasesize = (64 * 1024) << (extid & 0x03); ++ extid >>= 2; ++ /* Get buswidth information */ ++ busw = (extid & 0x01) ? NAND_BUSWIDTH_16 : 0; ++ ++ } else { ++ /* Old devices have this data hardcoded in the ++ * device id table */ ++ mtd->erasesize = nand_flash_ids[i].erasesize; ++ mtd->oobblock = nand_flash_ids[i].pagesize; ++ mtd->oobsize = mtd->oobblock / 32; ++ busw = nand_flash_ids[i].options & NAND_BUSWIDTH_16; ++ } ++ ++ /* Check, if buswidth is correct. Hardware drivers should set ++ * this correct ! */ ++ if (busw != (this->options & NAND_BUSWIDTH_16)) { ++ printk (KERN_INFO "NAND device: Manufacturer ID:" ++ " 0x%02x, Chip ID: 0x%02x (%s %s)\n", nand_maf_id, nand_dev_id, ++ nand_manuf_ids[i].name , mtd->name); ++ printk (KERN_WARNING ++ "NAND bus width %d instead %d bit\n", ++ (this->options & NAND_BUSWIDTH_16) ? 16 : 8, ++ busw ? 16 : 8); ++ this->select_chip(mtd, -1); ++ return 1; ++ } ++ ++ /* Calculate the address shift from the page size */ ++ this->page_shift = ffs(mtd->oobblock) - 1; ++ this->bbt_erase_shift = this->phys_erase_shift = ffs(mtd->erasesize) - 1; ++ this->chip_shift = ffs(this->chipsize) - 1; ++ ++ /* Set the bad block position */ ++ this->badblockpos = mtd->oobblock > 512 ? ++ NAND_LARGE_BADBLOCK_POS : NAND_SMALL_BADBLOCK_POS; ++ ++ /* Get chip options, preserve non chip based options */ ++ this->options &= ~NAND_CHIPOPTIONS_MSK; ++ this->options |= nand_flash_ids[i].options & NAND_CHIPOPTIONS_MSK; ++ /* Set this as a default. Board drivers can override it, if neccecary */ ++ this->options |= NAND_NO_AUTOINCR; ++ /* Check if this is a not a samsung device. Do not clear the options ++ * for chips which are not having an extended id. ++ */ ++ if (nand_maf_id != NAND_MFR_SAMSUNG && !nand_flash_ids[i].pagesize) ++ this->options &= ~NAND_SAMSUNG_LP_OPTIONS; ++ ++ /* Check for AND chips with 4 page planes */ ++ // if (this->options & NAND_4PAGE_ARRAY) ++ // this->erase_cmd = multi_erase_cmd; ++ // else ++ // this->erase_cmd = single_erase_cmd; ++ ++ /* Do not replace user supplied command function ! */ ++ // if (mtd->oobblock > 512 && this->cmdfunc == nand_command) ++ // this->cmdfunc = nand_command_lp; ++ ++ /* Try to identify manufacturer */ ++ for (j = 0; nand_manuf_ids[j].id != 0x0; j++) { ++ if (nand_manuf_ids[j].id == nand_maf_id) ++ break; ++ } ++ printk (KERN_INFO "NAND device: Manufacturer ID:" ++ " 0x%02x, Chip ID: 0x%02x (%s %s)\n", nand_maf_id, nand_dev_id, ++ nand_manuf_ids[j].name , nand_flash_ids[i].name); ++ break; ++ } ++ ///////////////////////////// ++ ++ for (i=1; i < maxchips; i++) { ++ this->select_chip(mtd, i); ++ ++ /* Send the command for reading device ID */ ++ nand_read_id(1,id); ++ ++ /* Read manufacturer and device IDs */ ++ if (nand_maf_id != id[0] || ++ nand_dev_id != id[1]) ++ break; ++ } ++ if (i > 1) ++ printk(KERN_INFO "%d NAND chips detected\n", i); ++ ++ /* Allocate buffers, if neccecary */ ++ if (!this->oob_buf) { ++ size_t len; ++ len = mtd->oobsize << (this->phys_erase_shift - this->page_shift); ++ this->oob_buf = kmalloc (len, GFP_KERNEL); ++ if (!this->oob_buf) { ++ printk (KERN_ERR "nand_scan(): Cannot allocate oob_buf\n"); ++ return -ENOMEM; ++ } ++ this->options |= NAND_OOBBUF_ALLOC; ++ } ++ ++ if (!this->data_buf) { ++ size_t len; ++ len = mtd->oobblock + mtd->oobsize; ++ this->data_buf = kmalloc (len, GFP_KERNEL); ++ if (!this->data_buf) { ++ if (this->options & NAND_OOBBUF_ALLOC) ++ kfree (this->oob_buf); ++ printk (KERN_ERR "nand_scan(): Cannot allocate data_buf\n"); ++ return -ENOMEM; ++ } ++ this->options |= NAND_DATABUF_ALLOC; ++ } ++ ++ /* Store the number of chips and calc total size for mtd */ ++ this->numchips = i; ++ mtd->size = i * this->chipsize; ++ /* Convert chipsize to number of pages per chip -1. */ ++ this->pagemask = (this->chipsize >> this->page_shift) - 1; ++ /* Preset the internal oob buffer */ ++ memset(this->oob_buf, 0xff, mtd->oobsize << (this->phys_erase_shift - this->page_shift)); ++ ++ /* If no default placement scheme is given, select an ++ * appropriate one */ ++ if (!this->autooob) { ++ /* Select the appropriate default oob placement scheme for ++ * placement agnostic filesystems */ ++ switch (mtd->oobsize) { ++ case 8: ++ this->autooob = &nand_oob_8; ++ break; ++ case 16: ++ this->autooob = &nand_oob_16; ++ break; ++ case 64: ++ this->autooob = &nand_oob_64; ++ break; ++ default: ++ printk (KERN_WARNING "No oob scheme defined for oobsize %d\n", ++ mtd->oobsize); ++ BUG(); ++ } ++ } ++ ++ /* The number of bytes available for the filesystem to place fs dependend ++ * oob data */ ++ if (this->options & NAND_BUSWIDTH_16) { ++ mtd->oobavail = mtd->oobsize - (this->autooob->eccbytes + 2); ++ if (this->autooob->eccbytes & 0x01) ++ mtd->oobavail--; ++ } else ++ mtd->oobavail = mtd->oobsize - (this->autooob->eccbytes + 1); ++ ++ ++ /* ++ * check ECC mode, default to software ++ * if 3byte/512byte hardware ECC is selected and we have 256 byte pagesize ++ * fallback to software ECC ++ */ ++ this->eccsize = 256; /* set default eccsize */ ++ this->eccbytes = 3; ++ ++ switch (this->eccmode) { ++ case NAND_ECC_HW12_2048: ++ if (mtd->oobblock < 2048) { ++ printk(KERN_WARNING "2048 byte HW ECC not possible on %d byte page size, fallback to SW ECC\n", ++ mtd->oobblock); ++ this->eccmode = NAND_ECC_SOFT; ++ this->calculate_ecc = nand_calculate_ecc; ++ this->correct_data = nand_correct_data; ++ } else ++ this->eccsize = 2048; ++ break; ++ ++ case NAND_ECC_HW3_512: ++ case NAND_ECC_HW6_512: ++ case NAND_ECC_HW8_512: ++ if (mtd->oobblock == 256) { ++ printk (KERN_WARNING "512 byte HW ECC not possible on 256 Byte pagesize, fallback to SW ECC \n"); ++ this->eccmode = NAND_ECC_SOFT; ++ this->calculate_ecc = nand_calculate_ecc; ++ this->correct_data = nand_correct_data; ++ } else ++ this->eccsize = 512; /* set eccsize to 512 */ ++ break; ++ ++ case NAND_ECC_HW3_256: ++ break; ++ ++ case NAND_ECC_NONE: ++ printk (KERN_WARNING "NAND_ECC_NONE selected by board driver. This is not recommended !!\n"); ++ this->eccmode = NAND_ECC_NONE; ++ break; ++ ++ case NAND_ECC_SOFT: ++ this->calculate_ecc = nand_calculate_ecc; ++ this->correct_data = nand_correct_data; ++ break; ++ ++ default: ++ printk (KERN_WARNING "Invalid NAND_ECC_MODE %d\n", this->eccmode); ++ BUG(); ++ } ++ ++ /* Check hardware ecc function availability and adjust number of ecc bytes per ++ * calculation step ++ */ ++ switch (this->eccmode) { ++ case NAND_ECC_HW12_2048: ++ this->eccbytes += 4; ++ case NAND_ECC_HW8_512: ++ this->eccbytes += 2; ++ case NAND_ECC_HW6_512: ++ this->eccbytes += 3; ++// case NAND_ECC_HW3_512: ++ case NAND_ECC_HW3_256: ++ if (this->calculate_ecc && this->correct_data && this->enable_hwecc) ++ break; ++ printk (KERN_WARNING "No ECC functions supplied, Hardware ECC not possible\n"); ++ BUG(); ++ } ++ ++ mtd->eccsize = this->eccsize; ++ ++ /* Set the number of read / write steps for one page to ensure ECC generation */ ++ switch (this->eccmode) { ++ case NAND_ECC_HW12_2048: ++ this->eccsteps = mtd->oobblock / 2048; ++ break; ++ case NAND_ECC_HW3_512: ++ case NAND_ECC_HW6_512: ++ case NAND_ECC_HW8_512: ++ this->eccsteps = mtd->oobblock / 512; ++ break; ++ case NAND_ECC_HW3_256: ++ case NAND_ECC_SOFT: ++ this->eccsteps = mtd->oobblock / 256; ++ break; ++ ++ case NAND_ECC_NONE: ++ this->eccsteps = 1; ++ break; ++ } ++ ++ /* Initialize state, waitqueue and spinlock */ ++ this->state = FL_READY; ++ init_waitqueue_head (&this->wq); ++ spin_lock_init (&this->chip_lock); ++ ++ /* De-select the device */ ++ this->select_chip(mtd, 0); ++ ++ /* Print warning message for no device */ ++ if (!mtd->size) { ++ printk (KERN_WARNING "No NAND device found!!!\n"); ++ return 1; ++ } ++ ++ /* Fill in remaining MTD driver data */ ++ mtd->type = MTD_NANDFLASH; ++ mtd->flags = MTD_CAP_NANDFLASH | MTD_ECC; ++ mtd->ecctype = MTD_ECC_SW; ++ mtd->erase = sl2312_nand_erase; ++ mtd->point = NULL; ++ mtd->unpoint = NULL; ++ mtd->read = sl2312_nand_read; ++ mtd->write = sl2312_nand_write; ++ mtd->read_ecc = sl2312_nand_read_ecc; ++ mtd->write_ecc = sl2312_nand_write_ecc; ++ mtd->read_oob = sl2312_nand_read_oob; ++ mtd->write_oob = sl2312_nand_write_oob; ++ mtd->readv = NULL; ++ mtd->writev = sl2312_nand_writev; ++ mtd->writev_ecc = sl2312_nand_writev_ecc; ++ mtd->sync = sl2312_nand_sync; ++ mtd->lock = NULL; ++ mtd->unlock = NULL; ++ mtd->suspend = NULL; ++ mtd->resume = NULL; ++ mtd->block_isbad = sl2312_nand_block_isbad; ++ mtd->block_markbad = sl2312_nand_block_markbad; ++ ++ /* and make the autooob the default one */ ++ memcpy(&mtd->oobinfo, this->autooob, sizeof(mtd->oobinfo)); ++ ++ mtd->owner = THIS_MODULE; ++ ++ /* Build bad block table */ ++ return this->scan_bbt (mtd); ++} ++ ++/*End Add function*/ ++ ++/* ++ * Main initialization routine ++ */ ++extern int nand_correct_data(struct mtd_info *mtd, u_char *dat, u_char *read_ecc, u_char *calc_ecc); ++ ++int __init sl2312_mtd_init (void) ++{ ++ struct nand_chip *this; ++ int err = 0; ++ struct mtd_partition *parts; ++ int nr_parts = 0; ++ int ret, data, *base; ++ ++ printk("NAND MTD Driver Start Init ......\n"); ++ ++ base = (unsigned int *)(IO_ADDRESS(SL2312_GLOBAL_BASE) + 0x30); ++ data = *base; ++ data&=0xffffffeb; ++ data|=0x3; //disable p & s flash ++ *base = data; ++ ++ /* Allocate memory for MTD device structure and private data */ ++ sl2312_mtd = kmalloc(sizeof(struct mtd_info) + sizeof(struct nand_chip), GFP_KERNEL); ++ if (!sl2312_mtd) { ++ printk ("Unable to allocate SL2312 NAND MTD device structure.\n"); ++ err = -ENOMEM; ++ goto out; ++ } ++ ++ // sl2312_device_setup(); ++ ++ /* io is indirect via a register so don't need to ioremap address */ ++ ++ /* Get pointer to private data */ ++ this = (struct nand_chip *) (&sl2312_mtd[1]); ++ ++ /* Initialize structures */ ++ memset((char *) sl2312_mtd, 0, sizeof(struct mtd_info)); ++ memset((char *) this, 0, sizeof(struct nand_chip)); ++ ++ /* Link the private data with the MTD structure */ ++ sl2312_mtd->priv = this; ++ sl2312_mtd->name = "sl2312-nand"; ++ ++ /* Set address of NAND IO lines */ ++ this->IO_ADDR_R = (void __iomem *)IO_ADDRESS((SL2312_FLASH_CTRL_BASE+NFLASH_DATA)); //(unsigned long)&(sl2312_ndfmcptr->dtr); ++ this->IO_ADDR_W = (void __iomem *)IO_ADDRESS((SL2312_FLASH_CTRL_BASE+NFLASH_DATA)); //(unsigned long)&(sl2312_ndfmcptr->dtr); ++ this->read_byte = sl2312_nand_read_byte; ++ this->write_byte = sl2312_nand_write_byte; ++ this->write_buf = sl2312_nand_write_buf; ++ this->read_buf = sl2312_nand_read_buf; ++ this->verify_buf = sl2312_nand_verify_buf; ++ this->select_chip = sl2312_nand_select_chip; ++ this->block_bad = sl2312_nand_block_bad; ++ this->hwcontrol = sl2312_hwcontrol; ++ this->dev_ready = sl2312_device_ready; ++ this->cmdfunc = sl2312_nand_command; ++ this->waitfunc = sl2312_nand_waitfunc; ++ //this->calculate_ecc = sl2312_readecc; ++ this->enable_hwecc = sl2312_enable_hwecc; ++ this->eccmode = NAND_ECC_HW3_512; ++ /*this->eccsize = 512; */ ++ /* 20 us command delay time */ ++ this->chip_delay = 20; ++ ++ this->correct_data = nand_correct_data; ++// this->scan_bbt = sl2312_nand_scan_bbt; ++ ++ /* Allocate memory for internal data buffer */ ++ this->data_buf = kmalloc (sizeof(u_char) * (sl2312_mtd->oobblock + sl2312_mtd->oobsize), GFP_KERNEL); ++ if (!this->data_buf) { ++ printk ("Unable to allocate NAND data buffer.\n"); ++ err = -ENOMEM; ++ goto out_ior; ++ } ++ ++ /* Scan to find existance of the device */ ++ if (sl2312_nand_scan(sl2312_mtd, 1)) { ++ err = -ENXIO; ++ goto out_ior; ++ } ++ ++ /* Register the partitions */ ++ parts = sl2312_partitions; ++ nr_parts = sizeof(sl2312_partitions)/sizeof(*parts); ++ ++ ret = add_mtd_partitions(sl2312_mtd, sl2312_partitions, nr_parts); ++ /*If we got an error, free all resources.*/ ++ if (ret < 0) { ++ del_mtd_partitions(sl2312_mtd); ++ map_destroy(sl2312_mtd); ++ } ++ goto out; ++ ++//out_buf: ++// kfree (this->data_buf); ++out_ior: ++out: ++ printk("NAND MTD Driver Init Success ......\n"); ++ return err; ++} ++ ++module_init(sl2312_mtd_init); ++ ++/* ++ * Clean up routine ++ */ ++#ifdef MODULE ++static void __exit sl2312_cleanup (void) ++{ ++ struct nand_chip *this = (struct nand_chip *) &sl2312_mtd[1]; ++ ++ /* Unregister partitions */ ++ del_mtd_partitions(sl2312_mtd); ++ ++ /* Unregister the device */ ++ del_mtd_device (sl2312_mtd); ++ ++ /* Free internal data buffers */ ++ kfree (this->data_buf); ++ ++ /* Free the MTD device structure */ ++ kfree (sl2312_mtd); ++} ++module_exit(sl2312_cleanup); ++#endif ++ ++MODULE_LICENSE("GPL"); ++MODULE_AUTHOR("Alice Hennessy <ahennessy@mvista.com>"); ++MODULE_DESCRIPTION("Glue layer for SmartMediaCard on Toshiba RBsl2312"); +Index: linux-2.6.23.16/drivers/mtd/nand/sl2312-flash-nand.h +=================================================================== +--- /dev/null 1970-01-01 00:00:00.000000000 +0000 ++++ linux-2.6.23.16/drivers/mtd/nand/sl2312-flash-nand.h 2008-03-15 17:04:25.878696749 +0200 +@@ -0,0 +1,24 @@ ++#ifndef SL2312_FLASH_NAND_H ++#define SL2312_FLASH_NAND_H ++ ++#include <linux/wait.h>
++#include <linux/spinlock.h> ++ ++/*Add function*/ ++static void nand_read_id(int chip_no,unsigned char *id); ++
++
++
++#define NFLASH_WiDTH8 0x00000000 ++#define NFLASH_WiDTH16 0x00000400 ++#define NFLASH_WiDTH32 0x00000800
++#define NFLASH_CHIP0_EN 0x00000000 // 16th bit = 0 ++#define NFLASH_CHIP1_EN 0x00010000 // 16th bit = 1 ++#define NFLASH_DIRECT 0x00004000 ++#define NFLASH_INDIRECT 0x00000000
++
++
++#define DWIDTH NFLASH_WiDTH8
++
++ ++#endif /* SL2312_FLASH_NAND_H */ +Index: linux-2.6.23.16/include/linux/mtd/kvctl.h +=================================================================== +--- /dev/null 1970-01-01 00:00:00.000000000 +0000 ++++ linux-2.6.23.16/include/linux/mtd/kvctl.h 2008-03-15 17:03:17.874821522 +0200 +@@ -0,0 +1,40 @@ ++#ifndef KVCTL_H ++#define KVCTL_H ++ ++#define VCTL_HEAD_SIZE 8 ++#define VCTL_ENTRY_LEN 20 ++ ++typedef struct ++{ ++ char header[4]; ++ unsigned int entry_num; ++} vctl_mheader; ++ ++typedef struct ++{ ++ char header[4]; ++ unsigned int size; ++ unsigned int type; ++ char majorver[4]; ++ char minorver[4]; ++ unsigned char *payload; ++} vctl_entry; ++ ++typedef struct ++{ ++ unsigned char mac[6]; ++ unsigned char vlanid; ++ unsigned char vlanmap; ++} vlaninfo; ++ ++#define VCT_VENDORSPEC 0 ++#define VCT_BOOTLOADER 1 ++#define VCT_KERNEL 2 ++#define VCT_VERCTL 3 ++#define VCT_CURRCONF 4 ++#define VCT_DEFAULTCONF 5 ++#define VCT_ROOTFS 6 ++#define VCT_APP 7 ++#define VCT_VLAN 8 ++ ++#endif +Index: linux-2.6.23.16/drivers/mtd/maps/Makefile +=================================================================== +--- linux-2.6.23.16.orig/drivers/mtd/maps/Makefile 2008-03-15 17:03:14.374622039 +0200 ++++ linux-2.6.23.16/drivers/mtd/maps/Makefile 2008-03-15 17:03:17.874821522 +0200 +@@ -71,3 +71,7 @@ + obj-$(CONFIG_MTD_OMAP_NOR) += omap_nor.o + obj-$(CONFIG_MTD_MTX1) += mtx-1_flash.o + obj-$(CONFIG_MTD_TQM834x) += tqm834x.o ++###### for Storlink Soc ####### ++obj-$(CONFIG_MTD_SL2312_CFI) += sl2312-flash-cfi.o ++obj-$(CONFIG_MTD_SL2312_SERIAL_ATMEL) += sl2312-flash-atmel.o ++obj-$(CONFIG_MTD_SL2312_SERIAL_ST) += sl2312-flash-m25p80.o |