diff -ruP linux-2.4.22.old/drivers/mtd/chips/jedec_probe.c linux-2.4.22/drivers/mtd/chips/jedec_probe.c --- linux-2.4.22.old/drivers/mtd/chips/jedec_probe.c Fri Jun 13 16:51:34 2003 +++ linux-2.4.22/drivers/mtd/chips/jedec_probe.c Tue Sep 2 06:41:28 2003 @@ -1,4 +1,4 @@ -/* +/* Common Flash Interface probe code. (C) 2000 Red Hat. GPL'd. $Id: jedec_probe.c,v 1.19 2002/11/12 13:12:10 dwmw2 Exp $ @@ -38,6 +38,8 @@ #define AM29LV800BT 0x22DA #define AM29LV160DT 0x22C4 #define AM29LV160DB 0x2249 +#define AM29LV081 0x0038 +#define AM29LV017 0x00C8 #define AM29F017D 0x003D #define AM29F016 0x00AD #define AM29F080 0x00D5 @@ -900,11 +902,27 @@ NumEraseRegions: 1, regions: {ERASEINFO(0x01000,256), } - } + }, { + mfr_id: MANUFACTURER_AMD, + dev_id: AM29LV081, + name: "AMD AM29LV081", + DevSize: SIZE_1MiB, + NumEraseRegions: 1, + regions: {ERASEINFO(0x10000,16), + } + }, { + mfr_id: MANUFACTURER_AMD, + dev_id: AM29LV017, + name: "AMD AM29LV017", + DevSize: SIZE_2MiB, + NumEraseRegions: 1, + regions: {ERASEINFO(0x10000,32), + } + } }; -static int cfi_jedec_setup(struct cfi_private *p_cfi, int index); +static int cfi_jedec_setup(struct map_info *map, struct cfi_private *p_cfi, int index); static int jedec_probe_chip(struct map_info *map, __u32 base, struct flchip *chips, struct cfi_private *cfi); @@ -946,11 +964,16 @@ cfi_send_gen_cmd(0xFF, 0, base, map, cfi, cfi->device_type, NULL); } -static int cfi_jedec_setup(struct cfi_private *p_cfi, int index) + +static int cfi_jedec_setup(struct map_info *map, struct cfi_private *p_cfi, int index) { int i,num_erase_regions; - printk("Found: %s\n",jedec_table[index].name); + printk("%s: Found %s\n", map->name, jedec_table[index].name); + + printk(KERN_INFO "%s: Found %d x%d devices at 0x0 in %d-bit mode\n", + map->name, p_cfi->interleave, p_cfi->device_type * 8, + map->buswidth * 8); num_erase_regions = jedec_table[index].NumEraseRegions; @@ -974,6 +997,40 @@ return 1; /* ok */ } +#define JEDEC_MATCH(val) jedec_match_pattern(map, cfi, (val)) + +static int jedec_match_pattern(struct map_info *map, struct cfi_private *cfi, __u16 value) { + + int i = 0, tmp = 0, bw_il = 0, mask_val = 0; + + bw_il = map->buswidth/cfi->interleave; + mask_val = value & ((1 << (bw_il << 3)) - 1); + + /* Create pattern for given configuration */ + for (i = 0; i < cfi->interleave; i += bw_il) { + tmp |= mask_val << (i * bw_il << 3); + } + + return tmp; +} + +#define JEDEC_FIND(mfr, id) jedec_find_chip(map, cfi, (mfr), (id)) + +static int jedec_find_chip(struct map_info *map, struct cfi_private *cfi, + int mfr, int id) { + + int i; + + for (i=0; i < sizeof(jedec_table)/sizeof(jedec_table[0]); i++) { + + if (mfr == JEDEC_MATCH(jedec_table[i].mfr_id) && + id == JEDEC_MATCH(jedec_table[i].dev_id)) + return i; + } + + return -1; +} + static int jedec_probe_chip(struct map_info *map, __u32 base, struct flchip *chips, struct cfi_private *cfi) { @@ -1040,6 +1097,9 @@ cfi_send_gen_cmd(0x90, cfi->addr_unlock1, base, map, cfi, CFI_DEVICETYPE_X8, NULL); if (!cfi->numchips) { + + int chip_ind = 0; + /* This is the first time we're called. Set up the CFI stuff accordingly and return */ @@ -1047,14 +1107,20 @@ cfi->id = jedec_read_id(map, base, cfi); printk(KERN_INFO "Search for id:(%02x %02x) interleave(%d) type(%d)\n", cfi->mfr, cfi->id, cfi->interleave, cfi->device_type); - for (i=0; imfr == jedec_table[i].mfr_id && - cfi->id == jedec_table[i].dev_id) { - if (!cfi_jedec_setup(cfi, i)) - return 0; - goto ok_out; - } - } + +// for (i=0; imfr == jedec_table[i].mfr_id && +// cfi->id == jedec_table[i].dev_id) { +// if (!cfi_jedec_setup(cfi, i)) +// return 0; +// goto ok_out; +// } +// } + + /* See if the chip is supported */ + if (-1 < (chip_ind = JEDEC_FIND(cfi->mfr, cfi->id))) + return cfi_jedec_setup(map, cfi, chip_ind); + switch(unlockpass++) { case 0: cfi->addr_unlock1 |= cfi->addr_unlock1 << 4; @@ -1080,7 +1146,7 @@ return 0; } } - + /* Check each previous chip to see if it's an alias */ for (i=0; inumchips; i++) { /* This chip should be in read mode if it's one @@ -1092,8 +1158,8 @@ jedec_reset(chips[i].start, map, cfi); /* If the device IDs go away, it's an alias */ - if (jedec_read_mfr(map, base, cfi) != cfi->mfr || - jedec_read_id(map, base, cfi) != cfi->id) { + if (jedec_read_mfr(map, chips[i].start, cfi) != cfi->mfr || + jedec_read_id(map, chips[i].start, cfi) != cfi->id) { printk(KERN_DEBUG "%s: Found an alias at 0x%x for the chip at 0x%lx\n", map->name, base, chips[i].start); return 0; @@ -1129,7 +1195,7 @@ jedec_reset(base, map, cfi); printk(KERN_INFO "%s: Found %d x%d devices at 0x%x in %d-bit mode\n", - map->name, cfi->interleave, cfi->device_type*8, base, + map->name, cfi->interleave, cfi->device_type*8, base, map->buswidth*8); return 1; diff -ruP linux-2.4.22.old/drivers/mtd/maps/Config.in linux-2.4.22/drivers/mtd/maps/Config.in --- linux-2.4.22.old/drivers/mtd/maps/Config.in Fri Jun 13 16:51:34 2003 +++ linux-2.4.22/drivers/mtd/maps/Config.in Mon Sep 1 08:19:03 2003 @@ -17,6 +17,10 @@ dep_tristate ' Sun Microsystems userflash support' CONFIG_MTD_SUN_UFLASH $CONFIG_MTD_CFI fi +if [ "$CONFIG_SPARC" = "y" -o "$CONFIG_SPARC32" = "y" ]; then + dep_tristate ' Sun Microsystems Javastation OS-flash support' CONFIG_MTD_SUN_JSFLASH $CONFIG_MTD_CFI +fi + if [ "$CONFIG_X86" = "y" ]; then dep_tristate ' CFI Flash device mapped on Photron PNC-2000' CONFIG_MTD_PNC2000 $CONFIG_MTD_CFI $CONFIG_MTD_PARTITIONS dep_tristate ' CFI Flash device mapped on AMD SC520 CDP' CONFIG_MTD_SC520CDP $CONFIG_MTD_CFI diff -ruP linux-2.4.22.old/drivers/mtd/maps/Makefile linux-2.4.22/drivers/mtd/maps/Makefile --- linux-2.4.22.old/drivers/mtd/maps/Makefile Fri Jun 13 16:51:34 2003 +++ linux-2.4.22/drivers/mtd/maps/Makefile Mon Sep 1 18:14:32 2003 @@ -61,5 +61,6 @@ obj-$(CONFIG_MTD_UCLINUX) += uclinux.o obj-$(CONFIG_MTD_NETtel) += nettel.o obj-$(CONFIG_MTD_SCB2_FLASH) += scb2_flash.o +obj-$(CONFIG_MTD_SUN_JSFLASH) += jsflash.o include $(TOPDIR)/Rules.make diff -ruP linux-2.4.22.old/drivers/mtd/maps/jsflash.c linux-2.4.22/drivers/mtd/maps/jsflash.c --- linux-2.4.22.old/drivers/mtd/maps/jsflash.c Thu Jan 1 01:00:00 1970 +++ linux-2.4.22/drivers/mtd/maps/jsflash.c Mon Sep 1 08:19:03 2003 @@ -0,0 +1,186 @@ +/* $Id: sun_uflash.c,v 1.4 2001/10/02 15:05:14 dwmw2 Exp $ + * + * drivers/mtd/maps/jsflash.c + * + * Copyright (C) 1999-2000 Pete Zaitcev (Old jsflash.c) + * Copyright (C) 2003 Jarno Manninen + * + * This module provides acces to a flash memory window + * on microsparc machines. + * + * The window is located at 0x20400000, size 16Mb. + * + * Devices used on Javastation should be JEDEC compliant + * so we just probe for them, which should detect chips. + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include + +#define JSFLASH_OBPNAME "flash-memory" +#define JSFLASH_DEVNAME "OS-flash" + +#define JSFLASH_ADDRESS 0x20400000 +#define JSFLASH_WINDOW_SIZE 0x01000000 /* 16Mb window */ +#define JSFLASH_BUSWIDTH 4 /* Native width */ + +MODULE_AUTHOR + ("Jarno Manninen "); +MODULE_DESCRIPTION + ("User-programmable flash device on Sun Javastations"); +MODULE_SUPPORTED_DEVICE + ("OS-flash"); +MODULE_LICENSE + ("GPL"); + +static __u32 jsflash_read32(struct map_info *map, unsigned long ofs) +{ + unsigned long retval, addr; + + /* Non 4-byte aligned accesses kill the system, + but MTD takes care of this after probing. */ + if (ofs & 0x3) { + printk("%s: unaligned offset %x\n", __FUNCTION__, ofs); + return 0; + } + + addr = JSFLASH_ADDRESS + ofs; + + __asm__ __volatile__("lda [%1] %2, %0\n\t" : + "=r" (retval) : + "r" (addr), "i" (ASI_M_BYPASS)); + + return retval; +} + +static void jsflash_copy_from(struct map_info *map, void *to, + unsigned long from, ssize_t len) +{ + union byte4 { + char s[4]; + unsigned int n; + } b; + + ssize_t size = 4; + + while (len > 0) { + b.n = jsflash_read32(map, from); + if (len < 4) { + size = len; + } + memcpy(to, b.s, size); + len -= size; + from += size; + to += size; + } + + if (len > 0) { + printk("%s: len (%d) > 0 at %x, unaligned?\n", __FUNCTION__, len, from); + b.n = jsflash_read32(map, from); + memcpy(to, b.s, len); + } +} + +static void jsflash_write32(struct map_info *map, __u32 data, + unsigned long ofs) +{ + + unsigned long addr; + + if (ofs & 0x3) { + printk("%s: unaligned offset %x", __FUNCTION__, ofs); + return; + } + + addr = JSFLASH_ADDRESS + ofs; + + __asm__ __volatile__("sta %0, [%1] %2\n\t" : : + "r" (data), "r" (addr), "i" (ASI_M_BYPASS) : + "memory"); +} + +static struct mtd_info *jsflash_mtd = 0; + +static struct map_info jsflash_map = { + + name: JSFLASH_DEVNAME, + size: JSFLASH_WINDOW_SIZE, + buswidth: JSFLASH_BUSWIDTH, + + read32: jsflash_read32, + copy_from: jsflash_copy_from, + write32: jsflash_write32, +}; + +/* + TODO! Create simple partitioning, with correct values + this is just for testing. +*/ + +static struct mtd_partition javastation_partitions[] = { + { + name: "Bootstrap", /* For proll??? */ + size: 0x100000, + offset: 0, + }, { + name: "Filesystem", + size: 0, /* Let the MTD fill it */ + offset: MTDPART_OFS_APPEND, + } +}; + +static int __init jsflash_init(void) +{ + int node; + struct linux_prom_registers reg0; + + node = prom_getchild(prom_root_node); + node = prom_searchsiblings(node, "flash-memory"); + + if (node == 0 || node == -1 || sparc_cpu_model != sun4m) { + return -ENXIO; + } + + /* Now we must be on sun4m. And supposedly on Javastation */ + + /* Try to probe around in the flash window */ + jsflash_mtd = do_map_probe("jedec_probe", &jsflash_map); + + if (0 == jsflash_mtd) { + return(-ENXIO); + } + + jsflash_mtd->module = THIS_MODULE; + add_mtd_device(jsflash_mtd); + add_mtd_partitions(jsflash_mtd, javastation_partitions, + (sizeof(javastation_partitions)/sizeof(struct mtd_partition))); + + return(0); +} + +static void __exit jsflash_cleanup(void) +{ + if (0 != jsflash_mtd) { + del_mtd_partitions(jsflash_mtd); + del_mtd_device(jsflash_mtd); + map_destroy(jsflash_mtd); + } +} + +module_init(jsflash_init); +module_exit(jsflash_cleanup);