11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * Common Flash Interface support: 31da177e4SLinus Torvalds * AMD & Fujitsu Standard Vendor Command Set (ID 0x0002) 41da177e4SLinus Torvalds * 51da177e4SLinus Torvalds * Copyright (C) 2000 Crossnet Co. <info@crossnet.co.jp> 61da177e4SLinus Torvalds * Copyright (C) 2004 Arcom Control Systems Ltd <linux@arcom.com> 702b15e34STodd Poynor * Copyright (C) 2005 MontaVista Software Inc. <source@mvista.com> 81da177e4SLinus Torvalds * 91da177e4SLinus Torvalds * 2_by_8 routines added by Simon Munton 101da177e4SLinus Torvalds * 111da177e4SLinus Torvalds * 4_by_16 work by Carolyn J. Smith 121da177e4SLinus Torvalds * 1302b15e34STodd Poynor * XIP support hooks by Vitaly Wool (based on code for Intel flash 1402b15e34STodd Poynor * by Nicolas Pitre) 1502b15e34STodd Poynor * 161da177e4SLinus Torvalds * Occasionally maintained by Thayne Harbaugh tharbaugh at lnxi dot com 171da177e4SLinus Torvalds * 181da177e4SLinus Torvalds * This code is GPL 191da177e4SLinus Torvalds * 20f8eb321bSThomas Gleixner * $Id: cfi_cmdset_0002.c,v 1.118 2005/07/04 22:34:29 gleixner Exp $ 211da177e4SLinus Torvalds * 221da177e4SLinus Torvalds */ 231da177e4SLinus Torvalds 241da177e4SLinus Torvalds #include <linux/config.h> 251da177e4SLinus Torvalds #include <linux/module.h> 261da177e4SLinus Torvalds #include <linux/types.h> 271da177e4SLinus Torvalds #include <linux/kernel.h> 281da177e4SLinus Torvalds #include <linux/sched.h> 291da177e4SLinus Torvalds #include <linux/init.h> 301da177e4SLinus Torvalds #include <asm/io.h> 311da177e4SLinus Torvalds #include <asm/byteorder.h> 321da177e4SLinus Torvalds 331da177e4SLinus Torvalds #include <linux/errno.h> 341da177e4SLinus Torvalds #include <linux/slab.h> 351da177e4SLinus Torvalds #include <linux/delay.h> 361da177e4SLinus Torvalds #include <linux/interrupt.h> 371da177e4SLinus Torvalds #include <linux/mtd/compatmac.h> 381da177e4SLinus Torvalds #include <linux/mtd/map.h> 391da177e4SLinus Torvalds #include <linux/mtd/mtd.h> 401da177e4SLinus Torvalds #include <linux/mtd/cfi.h> 4102b15e34STodd Poynor #include <linux/mtd/xip.h> 421da177e4SLinus Torvalds 431da177e4SLinus Torvalds #define AMD_BOOTLOC_BUG 441da177e4SLinus Torvalds #define FORCE_WORD_WRITE 0 451da177e4SLinus Torvalds 461da177e4SLinus Torvalds #define MAX_WORD_RETRIES 3 471da177e4SLinus Torvalds 481da177e4SLinus Torvalds #define MANUFACTURER_AMD 0x0001 491da177e4SLinus Torvalds #define MANUFACTURER_SST 0x00BF 501da177e4SLinus Torvalds #define SST49LF004B 0x0060 51fb4a90bfSEric W. Biedermann #define SST49LF008A 0x005a 521da177e4SLinus Torvalds 531da177e4SLinus Torvalds static int cfi_amdstd_read (struct mtd_info *, loff_t, size_t, size_t *, u_char *); 541da177e4SLinus Torvalds static int cfi_amdstd_write_words(struct mtd_info *, loff_t, size_t, size_t *, const u_char *); 551da177e4SLinus Torvalds static int cfi_amdstd_write_buffers(struct mtd_info *, loff_t, size_t, size_t *, const u_char *); 561da177e4SLinus Torvalds static int cfi_amdstd_erase_chip(struct mtd_info *, struct erase_info *); 571da177e4SLinus Torvalds static int cfi_amdstd_erase_varsize(struct mtd_info *, struct erase_info *); 581da177e4SLinus Torvalds static void cfi_amdstd_sync (struct mtd_info *); 591da177e4SLinus Torvalds static int cfi_amdstd_suspend (struct mtd_info *); 601da177e4SLinus Torvalds static void cfi_amdstd_resume (struct mtd_info *); 611da177e4SLinus Torvalds static int cfi_amdstd_secsi_read (struct mtd_info *, loff_t, size_t, size_t *, u_char *); 621da177e4SLinus Torvalds 631da177e4SLinus Torvalds static void cfi_amdstd_destroy(struct mtd_info *); 641da177e4SLinus Torvalds 651da177e4SLinus Torvalds struct mtd_info *cfi_cmdset_0002(struct map_info *, int); 661da177e4SLinus Torvalds static struct mtd_info *cfi_amdstd_setup (struct mtd_info *); 671da177e4SLinus Torvalds 681da177e4SLinus Torvalds static int get_chip(struct map_info *map, struct flchip *chip, unsigned long adr, int mode); 691da177e4SLinus Torvalds static void put_chip(struct map_info *map, struct flchip *chip, unsigned long adr); 701da177e4SLinus Torvalds #include "fwh_lock.h" 711da177e4SLinus Torvalds 721da177e4SLinus Torvalds static struct mtd_chip_driver cfi_amdstd_chipdrv = { 731da177e4SLinus Torvalds .probe = NULL, /* Not usable directly */ 741da177e4SLinus Torvalds .destroy = cfi_amdstd_destroy, 751da177e4SLinus Torvalds .name = "cfi_cmdset_0002", 761da177e4SLinus Torvalds .module = THIS_MODULE 771da177e4SLinus Torvalds }; 781da177e4SLinus Torvalds 791da177e4SLinus Torvalds 801da177e4SLinus Torvalds /* #define DEBUG_CFI_FEATURES */ 811da177e4SLinus Torvalds 821da177e4SLinus Torvalds 831da177e4SLinus Torvalds #ifdef DEBUG_CFI_FEATURES 841da177e4SLinus Torvalds static void cfi_tell_features(struct cfi_pri_amdstd *extp) 851da177e4SLinus Torvalds { 861da177e4SLinus Torvalds const char* erase_suspend[3] = { 871da177e4SLinus Torvalds "Not supported", "Read only", "Read/write" 881da177e4SLinus Torvalds }; 891da177e4SLinus Torvalds const char* top_bottom[6] = { 901da177e4SLinus Torvalds "No WP", "8x8KiB sectors at top & bottom, no WP", 911da177e4SLinus Torvalds "Bottom boot", "Top boot", 921da177e4SLinus Torvalds "Uniform, Bottom WP", "Uniform, Top WP" 931da177e4SLinus Torvalds }; 941da177e4SLinus Torvalds 951da177e4SLinus Torvalds printk(" Silicon revision: %d\n", extp->SiliconRevision >> 1); 961da177e4SLinus Torvalds printk(" Address sensitive unlock: %s\n", 971da177e4SLinus Torvalds (extp->SiliconRevision & 1) ? "Not required" : "Required"); 981da177e4SLinus Torvalds 991da177e4SLinus Torvalds if (extp->EraseSuspend < ARRAY_SIZE(erase_suspend)) 1001da177e4SLinus Torvalds printk(" Erase Suspend: %s\n", erase_suspend[extp->EraseSuspend]); 1011da177e4SLinus Torvalds else 1021da177e4SLinus Torvalds printk(" Erase Suspend: Unknown value %d\n", extp->EraseSuspend); 1031da177e4SLinus Torvalds 1041da177e4SLinus Torvalds if (extp->BlkProt == 0) 1051da177e4SLinus Torvalds printk(" Block protection: Not supported\n"); 1061da177e4SLinus Torvalds else 1071da177e4SLinus Torvalds printk(" Block protection: %d sectors per group\n", extp->BlkProt); 1081da177e4SLinus Torvalds 1091da177e4SLinus Torvalds 1101da177e4SLinus Torvalds printk(" Temporary block unprotect: %s\n", 1111da177e4SLinus Torvalds extp->TmpBlkUnprotect ? "Supported" : "Not supported"); 1121da177e4SLinus Torvalds printk(" Block protect/unprotect scheme: %d\n", extp->BlkProtUnprot); 1131da177e4SLinus Torvalds printk(" Number of simultaneous operations: %d\n", extp->SimultaneousOps); 1141da177e4SLinus Torvalds printk(" Burst mode: %s\n", 1151da177e4SLinus Torvalds extp->BurstMode ? "Supported" : "Not supported"); 1161da177e4SLinus Torvalds if (extp->PageMode == 0) 1171da177e4SLinus Torvalds printk(" Page mode: Not supported\n"); 1181da177e4SLinus Torvalds else 1191da177e4SLinus Torvalds printk(" Page mode: %d word page\n", extp->PageMode << 2); 1201da177e4SLinus Torvalds 1211da177e4SLinus Torvalds printk(" Vpp Supply Minimum Program/Erase Voltage: %d.%d V\n", 1221da177e4SLinus Torvalds extp->VppMin >> 4, extp->VppMin & 0xf); 1231da177e4SLinus Torvalds printk(" Vpp Supply Maximum Program/Erase Voltage: %d.%d V\n", 1241da177e4SLinus Torvalds extp->VppMax >> 4, extp->VppMax & 0xf); 1251da177e4SLinus Torvalds 1261da177e4SLinus Torvalds if (extp->TopBottom < ARRAY_SIZE(top_bottom)) 1271da177e4SLinus Torvalds printk(" Top/Bottom Boot Block: %s\n", top_bottom[extp->TopBottom]); 1281da177e4SLinus Torvalds else 1291da177e4SLinus Torvalds printk(" Top/Bottom Boot Block: Unknown value %d\n", extp->TopBottom); 1301da177e4SLinus Torvalds } 1311da177e4SLinus Torvalds #endif 1321da177e4SLinus Torvalds 1331da177e4SLinus Torvalds #ifdef AMD_BOOTLOC_BUG 1341da177e4SLinus Torvalds /* Wheee. Bring me the head of someone at AMD. */ 1351da177e4SLinus Torvalds static void fixup_amd_bootblock(struct mtd_info *mtd, void* param) 1361da177e4SLinus Torvalds { 1371da177e4SLinus Torvalds struct map_info *map = mtd->priv; 1381da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 1391da177e4SLinus Torvalds struct cfi_pri_amdstd *extp = cfi->cmdset_priv; 1401da177e4SLinus Torvalds __u8 major = extp->MajorVersion; 1411da177e4SLinus Torvalds __u8 minor = extp->MinorVersion; 1421da177e4SLinus Torvalds 1431da177e4SLinus Torvalds if (((major << 8) | minor) < 0x3131) { 1441da177e4SLinus Torvalds /* CFI version 1.0 => don't trust bootloc */ 1451da177e4SLinus Torvalds if (cfi->id & 0x80) { 1461da177e4SLinus Torvalds printk(KERN_WARNING "%s: JEDEC Device ID is 0x%02X. Assuming broken CFI table.\n", map->name, cfi->id); 1471da177e4SLinus Torvalds extp->TopBottom = 3; /* top boot */ 1481da177e4SLinus Torvalds } else { 1491da177e4SLinus Torvalds extp->TopBottom = 2; /* bottom boot */ 1501da177e4SLinus Torvalds } 1511da177e4SLinus Torvalds } 1521da177e4SLinus Torvalds } 1531da177e4SLinus Torvalds #endif 1541da177e4SLinus Torvalds 1551da177e4SLinus Torvalds static void fixup_use_write_buffers(struct mtd_info *mtd, void *param) 1561da177e4SLinus Torvalds { 1571da177e4SLinus Torvalds struct map_info *map = mtd->priv; 1581da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 1591da177e4SLinus Torvalds if (cfi->cfiq->BufWriteTimeoutTyp) { 1601da177e4SLinus Torvalds DEBUG(MTD_DEBUG_LEVEL1, "Using buffer write method\n" ); 1611da177e4SLinus Torvalds mtd->write = cfi_amdstd_write_buffers; 1621da177e4SLinus Torvalds } 1631da177e4SLinus Torvalds } 1641da177e4SLinus Torvalds 1651da177e4SLinus Torvalds static void fixup_use_secsi(struct mtd_info *mtd, void *param) 1661da177e4SLinus Torvalds { 1671da177e4SLinus Torvalds /* Setup for chips with a secsi area */ 1681da177e4SLinus Torvalds mtd->read_user_prot_reg = cfi_amdstd_secsi_read; 1691da177e4SLinus Torvalds mtd->read_fact_prot_reg = cfi_amdstd_secsi_read; 1701da177e4SLinus Torvalds } 1711da177e4SLinus Torvalds 1721da177e4SLinus Torvalds static void fixup_use_erase_chip(struct mtd_info *mtd, void *param) 1731da177e4SLinus Torvalds { 1741da177e4SLinus Torvalds struct map_info *map = mtd->priv; 1751da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 1761da177e4SLinus Torvalds if ((cfi->cfiq->NumEraseRegions == 1) && 1771da177e4SLinus Torvalds ((cfi->cfiq->EraseRegionInfo[0] & 0xffff) == 0)) { 1781da177e4SLinus Torvalds mtd->erase = cfi_amdstd_erase_chip; 1791da177e4SLinus Torvalds } 1801da177e4SLinus Torvalds 1811da177e4SLinus Torvalds } 1821da177e4SLinus Torvalds 1831da177e4SLinus Torvalds static struct cfi_fixup cfi_fixup_table[] = { 1841da177e4SLinus Torvalds #ifdef AMD_BOOTLOC_BUG 1851da177e4SLinus Torvalds { CFI_MFR_AMD, CFI_ID_ANY, fixup_amd_bootblock, NULL }, 1861da177e4SLinus Torvalds #endif 1871da177e4SLinus Torvalds { CFI_MFR_AMD, 0x0050, fixup_use_secsi, NULL, }, 1881da177e4SLinus Torvalds { CFI_MFR_AMD, 0x0053, fixup_use_secsi, NULL, }, 1891da177e4SLinus Torvalds { CFI_MFR_AMD, 0x0055, fixup_use_secsi, NULL, }, 1901da177e4SLinus Torvalds { CFI_MFR_AMD, 0x0056, fixup_use_secsi, NULL, }, 1911da177e4SLinus Torvalds { CFI_MFR_AMD, 0x005C, fixup_use_secsi, NULL, }, 1921da177e4SLinus Torvalds { CFI_MFR_AMD, 0x005F, fixup_use_secsi, NULL, }, 1931da177e4SLinus Torvalds #if !FORCE_WORD_WRITE 1941da177e4SLinus Torvalds { CFI_MFR_ANY, CFI_ID_ANY, fixup_use_write_buffers, NULL, }, 1951da177e4SLinus Torvalds #endif 1961da177e4SLinus Torvalds { 0, 0, NULL, NULL } 1971da177e4SLinus Torvalds }; 1981da177e4SLinus Torvalds static struct cfi_fixup jedec_fixup_table[] = { 1991da177e4SLinus Torvalds { MANUFACTURER_SST, SST49LF004B, fixup_use_fwh_lock, NULL, }, 200fb4a90bfSEric W. Biedermann { MANUFACTURER_SST, SST49LF008A, fixup_use_fwh_lock, NULL, }, 2011da177e4SLinus Torvalds { 0, 0, NULL, NULL } 2021da177e4SLinus Torvalds }; 2031da177e4SLinus Torvalds 2041da177e4SLinus Torvalds static struct cfi_fixup fixup_table[] = { 2051da177e4SLinus Torvalds /* The CFI vendor ids and the JEDEC vendor IDs appear 2061da177e4SLinus Torvalds * to be common. It is like the devices id's are as 2071da177e4SLinus Torvalds * well. This table is to pick all cases where 2081da177e4SLinus Torvalds * we know that is the case. 2091da177e4SLinus Torvalds */ 2101da177e4SLinus Torvalds { CFI_MFR_ANY, CFI_ID_ANY, fixup_use_erase_chip, NULL }, 2111da177e4SLinus Torvalds { 0, 0, NULL, NULL } 2121da177e4SLinus Torvalds }; 2131da177e4SLinus Torvalds 2141da177e4SLinus Torvalds 2151da177e4SLinus Torvalds struct mtd_info *cfi_cmdset_0002(struct map_info *map, int primary) 2161da177e4SLinus Torvalds { 2171da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 2181da177e4SLinus Torvalds struct mtd_info *mtd; 2191da177e4SLinus Torvalds int i; 2201da177e4SLinus Torvalds 2211da177e4SLinus Torvalds mtd = kmalloc(sizeof(*mtd), GFP_KERNEL); 2221da177e4SLinus Torvalds if (!mtd) { 2231da177e4SLinus Torvalds printk(KERN_WARNING "Failed to allocate memory for MTD device\n"); 2241da177e4SLinus Torvalds return NULL; 2251da177e4SLinus Torvalds } 2261da177e4SLinus Torvalds memset(mtd, 0, sizeof(*mtd)); 2271da177e4SLinus Torvalds mtd->priv = map; 2281da177e4SLinus Torvalds mtd->type = MTD_NORFLASH; 2291da177e4SLinus Torvalds 2301da177e4SLinus Torvalds /* Fill in the default mtd operations */ 2311da177e4SLinus Torvalds mtd->erase = cfi_amdstd_erase_varsize; 2321da177e4SLinus Torvalds mtd->write = cfi_amdstd_write_words; 2331da177e4SLinus Torvalds mtd->read = cfi_amdstd_read; 2341da177e4SLinus Torvalds mtd->sync = cfi_amdstd_sync; 2351da177e4SLinus Torvalds mtd->suspend = cfi_amdstd_suspend; 2361da177e4SLinus Torvalds mtd->resume = cfi_amdstd_resume; 2371da177e4SLinus Torvalds mtd->flags = MTD_CAP_NORFLASH; 2381da177e4SLinus Torvalds mtd->name = map->name; 2391da177e4SLinus Torvalds 2401da177e4SLinus Torvalds if (cfi->cfi_mode==CFI_MODE_CFI){ 2411da177e4SLinus Torvalds unsigned char bootloc; 2421da177e4SLinus Torvalds /* 2431da177e4SLinus Torvalds * It's a real CFI chip, not one for which the probe 2441da177e4SLinus Torvalds * routine faked a CFI structure. So we read the feature 2451da177e4SLinus Torvalds * table from it. 2461da177e4SLinus Torvalds */ 2471da177e4SLinus Torvalds __u16 adr = primary?cfi->cfiq->P_ADR:cfi->cfiq->A_ADR; 2481da177e4SLinus Torvalds struct cfi_pri_amdstd *extp; 2491da177e4SLinus Torvalds 2501da177e4SLinus Torvalds extp = (struct cfi_pri_amdstd*)cfi_read_pri(map, adr, sizeof(*extp), "Amd/Fujitsu"); 2511da177e4SLinus Torvalds if (!extp) { 2521da177e4SLinus Torvalds kfree(mtd); 2531da177e4SLinus Torvalds return NULL; 2541da177e4SLinus Torvalds } 2551da177e4SLinus Torvalds 2561da177e4SLinus Torvalds /* Install our own private info structure */ 2571da177e4SLinus Torvalds cfi->cmdset_priv = extp; 2581da177e4SLinus Torvalds 2591da177e4SLinus Torvalds /* Apply cfi device specific fixups */ 2601da177e4SLinus Torvalds cfi_fixup(mtd, cfi_fixup_table); 2611da177e4SLinus Torvalds 2621da177e4SLinus Torvalds #ifdef DEBUG_CFI_FEATURES 2631da177e4SLinus Torvalds /* Tell the user about it in lots of lovely detail */ 2641da177e4SLinus Torvalds cfi_tell_features(extp); 2651da177e4SLinus Torvalds #endif 2661da177e4SLinus Torvalds 2671da177e4SLinus Torvalds bootloc = extp->TopBottom; 2681da177e4SLinus Torvalds if ((bootloc != 2) && (bootloc != 3)) { 2691da177e4SLinus Torvalds printk(KERN_WARNING "%s: CFI does not contain boot " 2701da177e4SLinus Torvalds "bank location. Assuming top.\n", map->name); 2711da177e4SLinus Torvalds bootloc = 2; 2721da177e4SLinus Torvalds } 2731da177e4SLinus Torvalds 2741da177e4SLinus Torvalds if (bootloc == 3 && cfi->cfiq->NumEraseRegions > 1) { 2751da177e4SLinus Torvalds printk(KERN_WARNING "%s: Swapping erase regions for broken CFI table.\n", map->name); 2761da177e4SLinus Torvalds 2771da177e4SLinus Torvalds for (i=0; i<cfi->cfiq->NumEraseRegions / 2; i++) { 2781da177e4SLinus Torvalds int j = (cfi->cfiq->NumEraseRegions-1)-i; 2791da177e4SLinus Torvalds __u32 swap; 2801da177e4SLinus Torvalds 2811da177e4SLinus Torvalds swap = cfi->cfiq->EraseRegionInfo[i]; 2821da177e4SLinus Torvalds cfi->cfiq->EraseRegionInfo[i] = cfi->cfiq->EraseRegionInfo[j]; 2831da177e4SLinus Torvalds cfi->cfiq->EraseRegionInfo[j] = swap; 2841da177e4SLinus Torvalds } 2851da177e4SLinus Torvalds } 2861da177e4SLinus Torvalds /* Set the default CFI lock/unlock addresses */ 2871da177e4SLinus Torvalds cfi->addr_unlock1 = 0x555; 2881da177e4SLinus Torvalds cfi->addr_unlock2 = 0x2aa; 2891da177e4SLinus Torvalds /* Modify the unlock address if we are in compatibility mode */ 2901da177e4SLinus Torvalds if ( /* x16 in x8 mode */ 2911da177e4SLinus Torvalds ((cfi->device_type == CFI_DEVICETYPE_X8) && 2921da177e4SLinus Torvalds (cfi->cfiq->InterfaceDesc == 2)) || 2931da177e4SLinus Torvalds /* x32 in x16 mode */ 2941da177e4SLinus Torvalds ((cfi->device_type == CFI_DEVICETYPE_X16) && 2951da177e4SLinus Torvalds (cfi->cfiq->InterfaceDesc == 4))) 2961da177e4SLinus Torvalds { 2971da177e4SLinus Torvalds cfi->addr_unlock1 = 0xaaa; 2981da177e4SLinus Torvalds cfi->addr_unlock2 = 0x555; 2991da177e4SLinus Torvalds } 3001da177e4SLinus Torvalds 3011da177e4SLinus Torvalds } /* CFI mode */ 3021da177e4SLinus Torvalds else if (cfi->cfi_mode == CFI_MODE_JEDEC) { 3031da177e4SLinus Torvalds /* Apply jedec specific fixups */ 3041da177e4SLinus Torvalds cfi_fixup(mtd, jedec_fixup_table); 3051da177e4SLinus Torvalds } 3061da177e4SLinus Torvalds /* Apply generic fixups */ 3071da177e4SLinus Torvalds cfi_fixup(mtd, fixup_table); 3081da177e4SLinus Torvalds 3091da177e4SLinus Torvalds for (i=0; i< cfi->numchips; i++) { 3101da177e4SLinus Torvalds cfi->chips[i].word_write_time = 1<<cfi->cfiq->WordWriteTimeoutTyp; 3111da177e4SLinus Torvalds cfi->chips[i].buffer_write_time = 1<<cfi->cfiq->BufWriteTimeoutTyp; 3121da177e4SLinus Torvalds cfi->chips[i].erase_time = 1<<cfi->cfiq->BlockEraseTimeoutTyp; 3131da177e4SLinus Torvalds } 3141da177e4SLinus Torvalds 3151da177e4SLinus Torvalds map->fldrv = &cfi_amdstd_chipdrv; 3161da177e4SLinus Torvalds 3171da177e4SLinus Torvalds return cfi_amdstd_setup(mtd); 3181da177e4SLinus Torvalds } 3191da177e4SLinus Torvalds 3201da177e4SLinus Torvalds 3211da177e4SLinus Torvalds static struct mtd_info *cfi_amdstd_setup(struct mtd_info *mtd) 3221da177e4SLinus Torvalds { 3231da177e4SLinus Torvalds struct map_info *map = mtd->priv; 3241da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 3251da177e4SLinus Torvalds unsigned long devsize = (1<<cfi->cfiq->DevSize) * cfi->interleave; 3261da177e4SLinus Torvalds unsigned long offset = 0; 3271da177e4SLinus Torvalds int i,j; 3281da177e4SLinus Torvalds 3291da177e4SLinus Torvalds printk(KERN_NOTICE "number of %s chips: %d\n", 3301da177e4SLinus Torvalds (cfi->cfi_mode == CFI_MODE_CFI)?"CFI":"JEDEC",cfi->numchips); 3311da177e4SLinus Torvalds /* Select the correct geometry setup */ 3321da177e4SLinus Torvalds mtd->size = devsize * cfi->numchips; 3331da177e4SLinus Torvalds 3341da177e4SLinus Torvalds mtd->numeraseregions = cfi->cfiq->NumEraseRegions * cfi->numchips; 3351da177e4SLinus Torvalds mtd->eraseregions = kmalloc(sizeof(struct mtd_erase_region_info) 3361da177e4SLinus Torvalds * mtd->numeraseregions, GFP_KERNEL); 3371da177e4SLinus Torvalds if (!mtd->eraseregions) { 3381da177e4SLinus Torvalds printk(KERN_WARNING "Failed to allocate memory for MTD erase region info\n"); 3391da177e4SLinus Torvalds goto setup_err; 3401da177e4SLinus Torvalds } 3411da177e4SLinus Torvalds 3421da177e4SLinus Torvalds for (i=0; i<cfi->cfiq->NumEraseRegions; i++) { 3431da177e4SLinus Torvalds unsigned long ernum, ersize; 3441da177e4SLinus Torvalds ersize = ((cfi->cfiq->EraseRegionInfo[i] >> 8) & ~0xff) * cfi->interleave; 3451da177e4SLinus Torvalds ernum = (cfi->cfiq->EraseRegionInfo[i] & 0xffff) + 1; 3461da177e4SLinus Torvalds 3471da177e4SLinus Torvalds if (mtd->erasesize < ersize) { 3481da177e4SLinus Torvalds mtd->erasesize = ersize; 3491da177e4SLinus Torvalds } 3501da177e4SLinus Torvalds for (j=0; j<cfi->numchips; j++) { 3511da177e4SLinus Torvalds mtd->eraseregions[(j*cfi->cfiq->NumEraseRegions)+i].offset = (j*devsize)+offset; 3521da177e4SLinus Torvalds mtd->eraseregions[(j*cfi->cfiq->NumEraseRegions)+i].erasesize = ersize; 3531da177e4SLinus Torvalds mtd->eraseregions[(j*cfi->cfiq->NumEraseRegions)+i].numblocks = ernum; 3541da177e4SLinus Torvalds } 3551da177e4SLinus Torvalds offset += (ersize * ernum); 3561da177e4SLinus Torvalds } 3571da177e4SLinus Torvalds if (offset != devsize) { 3581da177e4SLinus Torvalds /* Argh */ 3591da177e4SLinus Torvalds printk(KERN_WARNING "Sum of regions (%lx) != total size of set of interleaved chips (%lx)\n", offset, devsize); 3601da177e4SLinus Torvalds goto setup_err; 3611da177e4SLinus Torvalds } 3621da177e4SLinus Torvalds #if 0 3631da177e4SLinus Torvalds // debug 3641da177e4SLinus Torvalds for (i=0; i<mtd->numeraseregions;i++){ 3651da177e4SLinus Torvalds printk("%d: offset=0x%x,size=0x%x,blocks=%d\n", 3661da177e4SLinus Torvalds i,mtd->eraseregions[i].offset, 3671da177e4SLinus Torvalds mtd->eraseregions[i].erasesize, 3681da177e4SLinus Torvalds mtd->eraseregions[i].numblocks); 3691da177e4SLinus Torvalds } 3701da177e4SLinus Torvalds #endif 3711da177e4SLinus Torvalds 3721da177e4SLinus Torvalds /* FIXME: erase-suspend-program is broken. See 3731da177e4SLinus Torvalds http://lists.infradead.org/pipermail/linux-mtd/2003-December/009001.html */ 3741da177e4SLinus Torvalds printk(KERN_NOTICE "cfi_cmdset_0002: Disabling erase-suspend-program due to code brokenness.\n"); 3751da177e4SLinus Torvalds 3761da177e4SLinus Torvalds __module_get(THIS_MODULE); 3771da177e4SLinus Torvalds return mtd; 3781da177e4SLinus Torvalds 3791da177e4SLinus Torvalds setup_err: 3801da177e4SLinus Torvalds if(mtd) { 3811da177e4SLinus Torvalds if(mtd->eraseregions) 3821da177e4SLinus Torvalds kfree(mtd->eraseregions); 3831da177e4SLinus Torvalds kfree(mtd); 3841da177e4SLinus Torvalds } 3851da177e4SLinus Torvalds kfree(cfi->cmdset_priv); 3861da177e4SLinus Torvalds kfree(cfi->cfiq); 3871da177e4SLinus Torvalds return NULL; 3881da177e4SLinus Torvalds } 3891da177e4SLinus Torvalds 3901da177e4SLinus Torvalds /* 3911da177e4SLinus Torvalds * Return true if the chip is ready. 3921da177e4SLinus Torvalds * 3931da177e4SLinus Torvalds * Ready is one of: read mode, query mode, erase-suspend-read mode (in any 3941da177e4SLinus Torvalds * non-suspended sector) and is indicated by no toggle bits toggling. 3951da177e4SLinus Torvalds * 3961da177e4SLinus Torvalds * Note that anything more complicated than checking if no bits are toggling 3971da177e4SLinus Torvalds * (including checking DQ5 for an error status) is tricky to get working 3981da177e4SLinus Torvalds * correctly and is therefore not done (particulary with interleaved chips 3991da177e4SLinus Torvalds * as each chip must be checked independantly of the others). 4001da177e4SLinus Torvalds */ 40102b15e34STodd Poynor static int __xipram chip_ready(struct map_info *map, unsigned long addr) 4021da177e4SLinus Torvalds { 4031da177e4SLinus Torvalds map_word d, t; 4041da177e4SLinus Torvalds 4051da177e4SLinus Torvalds d = map_read(map, addr); 4061da177e4SLinus Torvalds t = map_read(map, addr); 4071da177e4SLinus Torvalds 4081da177e4SLinus Torvalds return map_word_equal(map, d, t); 4091da177e4SLinus Torvalds } 4101da177e4SLinus Torvalds 411fb4a90bfSEric W. Biedermann /* 412fb4a90bfSEric W. Biedermann * Return true if the chip is ready and has the correct value. 413fb4a90bfSEric W. Biedermann * 414fb4a90bfSEric W. Biedermann * Ready is one of: read mode, query mode, erase-suspend-read mode (in any 415fb4a90bfSEric W. Biedermann * non-suspended sector) and it is indicated by no bits toggling. 416fb4a90bfSEric W. Biedermann * 417fb4a90bfSEric W. Biedermann * Error are indicated by toggling bits or bits held with the wrong value, 418fb4a90bfSEric W. Biedermann * or with bits toggling. 419fb4a90bfSEric W. Biedermann * 420fb4a90bfSEric W. Biedermann * Note that anything more complicated than checking if no bits are toggling 421fb4a90bfSEric W. Biedermann * (including checking DQ5 for an error status) is tricky to get working 422fb4a90bfSEric W. Biedermann * correctly and is therefore not done (particulary with interleaved chips 423fb4a90bfSEric W. Biedermann * as each chip must be checked independantly of the others). 424fb4a90bfSEric W. Biedermann * 425fb4a90bfSEric W. Biedermann */ 42602b15e34STodd Poynor static int __xipram chip_good(struct map_info *map, unsigned long addr, map_word expected) 427fb4a90bfSEric W. Biedermann { 428fb4a90bfSEric W. Biedermann map_word oldd, curd; 429fb4a90bfSEric W. Biedermann 430fb4a90bfSEric W. Biedermann oldd = map_read(map, addr); 431fb4a90bfSEric W. Biedermann curd = map_read(map, addr); 432fb4a90bfSEric W. Biedermann 433fb4a90bfSEric W. Biedermann return map_word_equal(map, oldd, curd) && 434fb4a90bfSEric W. Biedermann map_word_equal(map, curd, expected); 435fb4a90bfSEric W. Biedermann } 436fb4a90bfSEric W. Biedermann 4371da177e4SLinus Torvalds static int get_chip(struct map_info *map, struct flchip *chip, unsigned long adr, int mode) 4381da177e4SLinus Torvalds { 4391da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 4401da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 4411da177e4SLinus Torvalds unsigned long timeo; 4421da177e4SLinus Torvalds struct cfi_pri_amdstd *cfip = (struct cfi_pri_amdstd *)cfi->cmdset_priv; 4431da177e4SLinus Torvalds 4441da177e4SLinus Torvalds resettime: 4451da177e4SLinus Torvalds timeo = jiffies + HZ; 4461da177e4SLinus Torvalds retry: 4471da177e4SLinus Torvalds switch (chip->state) { 4481da177e4SLinus Torvalds 4491da177e4SLinus Torvalds case FL_STATUS: 4501da177e4SLinus Torvalds for (;;) { 4511da177e4SLinus Torvalds if (chip_ready(map, adr)) 4521da177e4SLinus Torvalds break; 4531da177e4SLinus Torvalds 4541da177e4SLinus Torvalds if (time_after(jiffies, timeo)) { 4551da177e4SLinus Torvalds printk(KERN_ERR "Waiting for chip to be ready timed out.\n"); 45602b15e34STodd Poynor spin_unlock(chip->mutex); 4571da177e4SLinus Torvalds return -EIO; 4581da177e4SLinus Torvalds } 45902b15e34STodd Poynor spin_unlock(chip->mutex); 4601da177e4SLinus Torvalds cfi_udelay(1); 46102b15e34STodd Poynor spin_lock(chip->mutex); 4621da177e4SLinus Torvalds /* Someone else might have been playing with it. */ 4631da177e4SLinus Torvalds goto retry; 4641da177e4SLinus Torvalds } 4651da177e4SLinus Torvalds 4661da177e4SLinus Torvalds case FL_READY: 4671da177e4SLinus Torvalds case FL_CFI_QUERY: 4681da177e4SLinus Torvalds case FL_JEDEC_QUERY: 4691da177e4SLinus Torvalds return 0; 4701da177e4SLinus Torvalds 4711da177e4SLinus Torvalds case FL_ERASING: 4721da177e4SLinus Torvalds if (mode == FL_WRITING) /* FIXME: Erase-suspend-program appears broken. */ 4731da177e4SLinus Torvalds goto sleep; 4741da177e4SLinus Torvalds 4751da177e4SLinus Torvalds if (!(mode == FL_READY || mode == FL_POINT 4761da177e4SLinus Torvalds || !cfip 4771da177e4SLinus Torvalds || (mode == FL_WRITING && (cfip->EraseSuspend & 0x2)) 4781da177e4SLinus Torvalds || (mode == FL_WRITING && (cfip->EraseSuspend & 0x1)))) 4791da177e4SLinus Torvalds goto sleep; 4801da177e4SLinus Torvalds 4811da177e4SLinus Torvalds /* We could check to see if we're trying to access the sector 4821da177e4SLinus Torvalds * that is currently being erased. However, no user will try 4831da177e4SLinus Torvalds * anything like that so we just wait for the timeout. */ 4841da177e4SLinus Torvalds 4851da177e4SLinus Torvalds /* Erase suspend */ 4861da177e4SLinus Torvalds /* It's harmless to issue the Erase-Suspend and Erase-Resume 4871da177e4SLinus Torvalds * commands when the erase algorithm isn't in progress. */ 4881da177e4SLinus Torvalds map_write(map, CMD(0xB0), chip->in_progress_block_addr); 4891da177e4SLinus Torvalds chip->oldstate = FL_ERASING; 4901da177e4SLinus Torvalds chip->state = FL_ERASE_SUSPENDING; 4911da177e4SLinus Torvalds chip->erase_suspended = 1; 4921da177e4SLinus Torvalds for (;;) { 4931da177e4SLinus Torvalds if (chip_ready(map, adr)) 4941da177e4SLinus Torvalds break; 4951da177e4SLinus Torvalds 4961da177e4SLinus Torvalds if (time_after(jiffies, timeo)) { 4971da177e4SLinus Torvalds /* Should have suspended the erase by now. 4981da177e4SLinus Torvalds * Send an Erase-Resume command as either 4991da177e4SLinus Torvalds * there was an error (so leave the erase 5001da177e4SLinus Torvalds * routine to recover from it) or we trying to 5011da177e4SLinus Torvalds * use the erase-in-progress sector. */ 5021da177e4SLinus Torvalds map_write(map, CMD(0x30), chip->in_progress_block_addr); 5031da177e4SLinus Torvalds chip->state = FL_ERASING; 5041da177e4SLinus Torvalds chip->oldstate = FL_READY; 5051da177e4SLinus Torvalds printk(KERN_ERR "MTD %s(): chip not ready after erase suspend\n", __func__); 5061da177e4SLinus Torvalds return -EIO; 5071da177e4SLinus Torvalds } 5081da177e4SLinus Torvalds 50902b15e34STodd Poynor spin_unlock(chip->mutex); 5101da177e4SLinus Torvalds cfi_udelay(1); 51102b15e34STodd Poynor spin_lock(chip->mutex); 5121da177e4SLinus Torvalds /* Nobody will touch it while it's in state FL_ERASE_SUSPENDING. 5131da177e4SLinus Torvalds So we can just loop here. */ 5141da177e4SLinus Torvalds } 5151da177e4SLinus Torvalds chip->state = FL_READY; 5161da177e4SLinus Torvalds return 0; 5171da177e4SLinus Torvalds 51802b15e34STodd Poynor case FL_XIP_WHILE_ERASING: 51902b15e34STodd Poynor if (mode != FL_READY && mode != FL_POINT && 52002b15e34STodd Poynor (!cfip || !(cfip->EraseSuspend&2))) 52102b15e34STodd Poynor goto sleep; 52202b15e34STodd Poynor chip->oldstate = chip->state; 52302b15e34STodd Poynor chip->state = FL_READY; 52402b15e34STodd Poynor return 0; 52502b15e34STodd Poynor 5261da177e4SLinus Torvalds case FL_POINT: 5271da177e4SLinus Torvalds /* Only if there's no operation suspended... */ 5281da177e4SLinus Torvalds if (mode == FL_READY && chip->oldstate == FL_READY) 5291da177e4SLinus Torvalds return 0; 5301da177e4SLinus Torvalds 5311da177e4SLinus Torvalds default: 5321da177e4SLinus Torvalds sleep: 5331da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 5341da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 53502b15e34STodd Poynor spin_unlock(chip->mutex); 5361da177e4SLinus Torvalds schedule(); 5371da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 53802b15e34STodd Poynor spin_lock(chip->mutex); 5391da177e4SLinus Torvalds goto resettime; 5401da177e4SLinus Torvalds } 5411da177e4SLinus Torvalds } 5421da177e4SLinus Torvalds 5431da177e4SLinus Torvalds 5441da177e4SLinus Torvalds static void put_chip(struct map_info *map, struct flchip *chip, unsigned long adr) 5451da177e4SLinus Torvalds { 5461da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 5471da177e4SLinus Torvalds 5481da177e4SLinus Torvalds switch(chip->oldstate) { 5491da177e4SLinus Torvalds case FL_ERASING: 5501da177e4SLinus Torvalds chip->state = chip->oldstate; 5511da177e4SLinus Torvalds map_write(map, CMD(0x30), chip->in_progress_block_addr); 5521da177e4SLinus Torvalds chip->oldstate = FL_READY; 5531da177e4SLinus Torvalds chip->state = FL_ERASING; 5541da177e4SLinus Torvalds break; 5551da177e4SLinus Torvalds 55602b15e34STodd Poynor case FL_XIP_WHILE_ERASING: 55702b15e34STodd Poynor chip->state = chip->oldstate; 55802b15e34STodd Poynor chip->oldstate = FL_READY; 55902b15e34STodd Poynor break; 56002b15e34STodd Poynor 5611da177e4SLinus Torvalds case FL_READY: 5621da177e4SLinus Torvalds case FL_STATUS: 5631da177e4SLinus Torvalds /* We should really make set_vpp() count, rather than doing this */ 5641da177e4SLinus Torvalds DISABLE_VPP(map); 5651da177e4SLinus Torvalds break; 5661da177e4SLinus Torvalds default: 5671da177e4SLinus Torvalds printk(KERN_ERR "MTD: put_chip() called with oldstate %d!!\n", chip->oldstate); 5681da177e4SLinus Torvalds } 5691da177e4SLinus Torvalds wake_up(&chip->wq); 5701da177e4SLinus Torvalds } 5711da177e4SLinus Torvalds 57202b15e34STodd Poynor #ifdef CONFIG_MTD_XIP 57302b15e34STodd Poynor 57402b15e34STodd Poynor /* 57502b15e34STodd Poynor * No interrupt what so ever can be serviced while the flash isn't in array 57602b15e34STodd Poynor * mode. This is ensured by the xip_disable() and xip_enable() functions 57702b15e34STodd Poynor * enclosing any code path where the flash is known not to be in array mode. 57802b15e34STodd Poynor * And within a XIP disabled code path, only functions marked with __xipram 57902b15e34STodd Poynor * may be called and nothing else (it's a good thing to inspect generated 58002b15e34STodd Poynor * assembly to make sure inline functions were actually inlined and that gcc 58102b15e34STodd Poynor * didn't emit calls to its own support functions). Also configuring MTD CFI 58202b15e34STodd Poynor * support to a single buswidth and a single interleave is also recommended. 58302b15e34STodd Poynor */ 584f8eb321bSThomas Gleixner 58502b15e34STodd Poynor static void xip_disable(struct map_info *map, struct flchip *chip, 58602b15e34STodd Poynor unsigned long adr) 58702b15e34STodd Poynor { 58802b15e34STodd Poynor /* TODO: chips with no XIP use should ignore and return */ 58902b15e34STodd Poynor (void) map_read(map, adr); /* ensure mmu mapping is up to date */ 59002b15e34STodd Poynor local_irq_disable(); 59102b15e34STodd Poynor } 59202b15e34STodd Poynor 59302b15e34STodd Poynor static void __xipram xip_enable(struct map_info *map, struct flchip *chip, 59402b15e34STodd Poynor unsigned long adr) 59502b15e34STodd Poynor { 59602b15e34STodd Poynor struct cfi_private *cfi = map->fldrv_priv; 59702b15e34STodd Poynor 59802b15e34STodd Poynor if (chip->state != FL_POINT && chip->state != FL_READY) { 59902b15e34STodd Poynor map_write(map, CMD(0xf0), adr); 60002b15e34STodd Poynor chip->state = FL_READY; 60102b15e34STodd Poynor } 60202b15e34STodd Poynor (void) map_read(map, adr); 60302b15e34STodd Poynor asm volatile (".rep 8; nop; .endr"); /* fill instruction prefetch */ 60402b15e34STodd Poynor local_irq_enable(); 60502b15e34STodd Poynor } 60602b15e34STodd Poynor 60702b15e34STodd Poynor /* 60802b15e34STodd Poynor * When a delay is required for the flash operation to complete, the 60902b15e34STodd Poynor * xip_udelay() function is polling for both the given timeout and pending 61002b15e34STodd Poynor * (but still masked) hardware interrupts. Whenever there is an interrupt 61102b15e34STodd Poynor * pending then the flash erase operation is suspended, array mode restored 61202b15e34STodd Poynor * and interrupts unmasked. Task scheduling might also happen at that 61302b15e34STodd Poynor * point. The CPU eventually returns from the interrupt or the call to 61402b15e34STodd Poynor * schedule() and the suspended flash operation is resumed for the remaining 61502b15e34STodd Poynor * of the delay period. 61602b15e34STodd Poynor * 61702b15e34STodd Poynor * Warning: this function _will_ fool interrupt latency tracing tools. 61802b15e34STodd Poynor */ 61902b15e34STodd Poynor 62002b15e34STodd Poynor static void __xipram xip_udelay(struct map_info *map, struct flchip *chip, 62102b15e34STodd Poynor unsigned long adr, int usec) 62202b15e34STodd Poynor { 62302b15e34STodd Poynor struct cfi_private *cfi = map->fldrv_priv; 62402b15e34STodd Poynor struct cfi_pri_amdstd *extp = cfi->cmdset_priv; 62502b15e34STodd Poynor map_word status, OK = CMD(0x80); 62602b15e34STodd Poynor unsigned long suspended, start = xip_currtime(); 62702b15e34STodd Poynor flstate_t oldstate; 62802b15e34STodd Poynor 62902b15e34STodd Poynor do { 63002b15e34STodd Poynor cpu_relax(); 63102b15e34STodd Poynor if (xip_irqpending() && extp && 63202b15e34STodd Poynor ((chip->state == FL_ERASING && (extp->EraseSuspend & 2))) && 63302b15e34STodd Poynor (cfi_interleave_is_1(cfi) || chip->oldstate == FL_READY)) { 63402b15e34STodd Poynor /* 63502b15e34STodd Poynor * Let's suspend the erase operation when supported. 63602b15e34STodd Poynor * Note that we currently don't try to suspend 63702b15e34STodd Poynor * interleaved chips if there is already another 63802b15e34STodd Poynor * operation suspended (imagine what happens 63902b15e34STodd Poynor * when one chip was already done with the current 64002b15e34STodd Poynor * operation while another chip suspended it, then 64102b15e34STodd Poynor * we resume the whole thing at once). Yes, it 64202b15e34STodd Poynor * can happen! 64302b15e34STodd Poynor */ 64402b15e34STodd Poynor map_write(map, CMD(0xb0), adr); 64502b15e34STodd Poynor usec -= xip_elapsed_since(start); 64602b15e34STodd Poynor suspended = xip_currtime(); 64702b15e34STodd Poynor do { 64802b15e34STodd Poynor if (xip_elapsed_since(suspended) > 100000) { 64902b15e34STodd Poynor /* 65002b15e34STodd Poynor * The chip doesn't want to suspend 65102b15e34STodd Poynor * after waiting for 100 msecs. 65202b15e34STodd Poynor * This is a critical error but there 65302b15e34STodd Poynor * is not much we can do here. 65402b15e34STodd Poynor */ 65502b15e34STodd Poynor return; 65602b15e34STodd Poynor } 65702b15e34STodd Poynor status = map_read(map, adr); 65802b15e34STodd Poynor } while (!map_word_andequal(map, status, OK, OK)); 65902b15e34STodd Poynor 66002b15e34STodd Poynor /* Suspend succeeded */ 66102b15e34STodd Poynor oldstate = chip->state; 66202b15e34STodd Poynor if (!map_word_bitsset(map, status, CMD(0x40))) 66302b15e34STodd Poynor break; 66402b15e34STodd Poynor chip->state = FL_XIP_WHILE_ERASING; 66502b15e34STodd Poynor chip->erase_suspended = 1; 66602b15e34STodd Poynor map_write(map, CMD(0xf0), adr); 66702b15e34STodd Poynor (void) map_read(map, adr); 66802b15e34STodd Poynor asm volatile (".rep 8; nop; .endr"); 66902b15e34STodd Poynor local_irq_enable(); 67002b15e34STodd Poynor spin_unlock(chip->mutex); 67102b15e34STodd Poynor asm volatile (".rep 8; nop; .endr"); 67202b15e34STodd Poynor cond_resched(); 67302b15e34STodd Poynor 67402b15e34STodd Poynor /* 67502b15e34STodd Poynor * We're back. However someone else might have 67602b15e34STodd Poynor * decided to go write to the chip if we are in 67702b15e34STodd Poynor * a suspended erase state. If so let's wait 67802b15e34STodd Poynor * until it's done. 67902b15e34STodd Poynor */ 68002b15e34STodd Poynor spin_lock(chip->mutex); 68102b15e34STodd Poynor while (chip->state != FL_XIP_WHILE_ERASING) { 68202b15e34STodd Poynor DECLARE_WAITQUEUE(wait, current); 68302b15e34STodd Poynor set_current_state(TASK_UNINTERRUPTIBLE); 68402b15e34STodd Poynor add_wait_queue(&chip->wq, &wait); 68502b15e34STodd Poynor spin_unlock(chip->mutex); 68602b15e34STodd Poynor schedule(); 68702b15e34STodd Poynor remove_wait_queue(&chip->wq, &wait); 68802b15e34STodd Poynor spin_lock(chip->mutex); 68902b15e34STodd Poynor } 69002b15e34STodd Poynor /* Disallow XIP again */ 69102b15e34STodd Poynor local_irq_disable(); 69202b15e34STodd Poynor 69302b15e34STodd Poynor /* Resume the write or erase operation */ 69402b15e34STodd Poynor map_write(map, CMD(0x30), adr); 69502b15e34STodd Poynor chip->state = oldstate; 69602b15e34STodd Poynor start = xip_currtime(); 69702b15e34STodd Poynor } else if (usec >= 1000000/HZ) { 69802b15e34STodd Poynor /* 69902b15e34STodd Poynor * Try to save on CPU power when waiting delay 70002b15e34STodd Poynor * is at least a system timer tick period. 70102b15e34STodd Poynor * No need to be extremely accurate here. 70202b15e34STodd Poynor */ 70302b15e34STodd Poynor xip_cpu_idle(); 70402b15e34STodd Poynor } 70502b15e34STodd Poynor status = map_read(map, adr); 70602b15e34STodd Poynor } while (!map_word_andequal(map, status, OK, OK) 70702b15e34STodd Poynor && xip_elapsed_since(start) < usec); 70802b15e34STodd Poynor } 70902b15e34STodd Poynor 71002b15e34STodd Poynor #define UDELAY(map, chip, adr, usec) xip_udelay(map, chip, adr, usec) 71102b15e34STodd Poynor 71202b15e34STodd Poynor /* 71302b15e34STodd Poynor * The INVALIDATE_CACHED_RANGE() macro is normally used in parallel while 71402b15e34STodd Poynor * the flash is actively programming or erasing since we have to poll for 71502b15e34STodd Poynor * the operation to complete anyway. We can't do that in a generic way with 71602b15e34STodd Poynor * a XIP setup so do it before the actual flash operation in this case 71702b15e34STodd Poynor * and stub it out from INVALIDATE_CACHE_UDELAY. 71802b15e34STodd Poynor */ 71902b15e34STodd Poynor #define XIP_INVAL_CACHED_RANGE(map, from, size) \ 72002b15e34STodd Poynor INVALIDATE_CACHED_RANGE(map, from, size) 72102b15e34STodd Poynor 72202b15e34STodd Poynor #define INVALIDATE_CACHE_UDELAY(map, chip, adr, len, usec) \ 72302b15e34STodd Poynor UDELAY(map, chip, adr, usec) 72402b15e34STodd Poynor 72502b15e34STodd Poynor /* 72602b15e34STodd Poynor * Extra notes: 72702b15e34STodd Poynor * 72802b15e34STodd Poynor * Activating this XIP support changes the way the code works a bit. For 72902b15e34STodd Poynor * example the code to suspend the current process when concurrent access 73002b15e34STodd Poynor * happens is never executed because xip_udelay() will always return with the 73102b15e34STodd Poynor * same chip state as it was entered with. This is why there is no care for 73202b15e34STodd Poynor * the presence of add_wait_queue() or schedule() calls from within a couple 73302b15e34STodd Poynor * xip_disable()'d areas of code, like in do_erase_oneblock for example. 73402b15e34STodd Poynor * The queueing and scheduling are always happening within xip_udelay(). 73502b15e34STodd Poynor * 73602b15e34STodd Poynor * Similarly, get_chip() and put_chip() just happen to always be executed 73702b15e34STodd Poynor * with chip->state set to FL_READY (or FL_XIP_WHILE_*) where flash state 73802b15e34STodd Poynor * is in array mode, therefore never executing many cases therein and not 73902b15e34STodd Poynor * causing any problem with XIP. 74002b15e34STodd Poynor */ 74102b15e34STodd Poynor 74202b15e34STodd Poynor #else 74302b15e34STodd Poynor 74402b15e34STodd Poynor #define xip_disable(map, chip, adr) 74502b15e34STodd Poynor #define xip_enable(map, chip, adr) 74602b15e34STodd Poynor #define XIP_INVAL_CACHED_RANGE(x...) 74702b15e34STodd Poynor 74802b15e34STodd Poynor #define UDELAY(map, chip, adr, usec) \ 74902b15e34STodd Poynor do { \ 75002b15e34STodd Poynor spin_unlock(chip->mutex); \ 75102b15e34STodd Poynor cfi_udelay(usec); \ 75202b15e34STodd Poynor spin_lock(chip->mutex); \ 75302b15e34STodd Poynor } while (0) 75402b15e34STodd Poynor 75502b15e34STodd Poynor #define INVALIDATE_CACHE_UDELAY(map, chip, adr, len, usec) \ 75602b15e34STodd Poynor do { \ 75702b15e34STodd Poynor spin_unlock(chip->mutex); \ 75802b15e34STodd Poynor INVALIDATE_CACHED_RANGE(map, adr, len); \ 75902b15e34STodd Poynor cfi_udelay(usec); \ 76002b15e34STodd Poynor spin_lock(chip->mutex); \ 76102b15e34STodd Poynor } while (0) 76202b15e34STodd Poynor 76302b15e34STodd Poynor #endif 7641da177e4SLinus Torvalds 7651da177e4SLinus Torvalds static inline int do_read_onechip(struct map_info *map, struct flchip *chip, loff_t adr, size_t len, u_char *buf) 7661da177e4SLinus Torvalds { 7671da177e4SLinus Torvalds unsigned long cmd_addr; 7681da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 7691da177e4SLinus Torvalds int ret; 7701da177e4SLinus Torvalds 7711da177e4SLinus Torvalds adr += chip->start; 7721da177e4SLinus Torvalds 7731da177e4SLinus Torvalds /* Ensure cmd read/writes are aligned. */ 7741da177e4SLinus Torvalds cmd_addr = adr & ~(map_bankwidth(map)-1); 7751da177e4SLinus Torvalds 77602b15e34STodd Poynor spin_lock(chip->mutex); 7771da177e4SLinus Torvalds ret = get_chip(map, chip, cmd_addr, FL_READY); 7781da177e4SLinus Torvalds if (ret) { 77902b15e34STodd Poynor spin_unlock(chip->mutex); 7801da177e4SLinus Torvalds return ret; 7811da177e4SLinus Torvalds } 7821da177e4SLinus Torvalds 7831da177e4SLinus Torvalds if (chip->state != FL_POINT && chip->state != FL_READY) { 7841da177e4SLinus Torvalds map_write(map, CMD(0xf0), cmd_addr); 7851da177e4SLinus Torvalds chip->state = FL_READY; 7861da177e4SLinus Torvalds } 7871da177e4SLinus Torvalds 7881da177e4SLinus Torvalds map_copy_from(map, buf, adr, len); 7891da177e4SLinus Torvalds 7901da177e4SLinus Torvalds put_chip(map, chip, cmd_addr); 7911da177e4SLinus Torvalds 79202b15e34STodd Poynor spin_unlock(chip->mutex); 7931da177e4SLinus Torvalds return 0; 7941da177e4SLinus Torvalds } 7951da177e4SLinus Torvalds 7961da177e4SLinus Torvalds 7971da177e4SLinus Torvalds static int cfi_amdstd_read (struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf) 7981da177e4SLinus Torvalds { 7991da177e4SLinus Torvalds struct map_info *map = mtd->priv; 8001da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 8011da177e4SLinus Torvalds unsigned long ofs; 8021da177e4SLinus Torvalds int chipnum; 8031da177e4SLinus Torvalds int ret = 0; 8041da177e4SLinus Torvalds 8051da177e4SLinus Torvalds /* ofs: offset within the first chip that the first read should start */ 8061da177e4SLinus Torvalds 8071da177e4SLinus Torvalds chipnum = (from >> cfi->chipshift); 8081da177e4SLinus Torvalds ofs = from - (chipnum << cfi->chipshift); 8091da177e4SLinus Torvalds 8101da177e4SLinus Torvalds 8111da177e4SLinus Torvalds *retlen = 0; 8121da177e4SLinus Torvalds 8131da177e4SLinus Torvalds while (len) { 8141da177e4SLinus Torvalds unsigned long thislen; 8151da177e4SLinus Torvalds 8161da177e4SLinus Torvalds if (chipnum >= cfi->numchips) 8171da177e4SLinus Torvalds break; 8181da177e4SLinus Torvalds 8191da177e4SLinus Torvalds if ((len + ofs -1) >> cfi->chipshift) 8201da177e4SLinus Torvalds thislen = (1<<cfi->chipshift) - ofs; 8211da177e4SLinus Torvalds else 8221da177e4SLinus Torvalds thislen = len; 8231da177e4SLinus Torvalds 8241da177e4SLinus Torvalds ret = do_read_onechip(map, &cfi->chips[chipnum], ofs, thislen, buf); 8251da177e4SLinus Torvalds if (ret) 8261da177e4SLinus Torvalds break; 8271da177e4SLinus Torvalds 8281da177e4SLinus Torvalds *retlen += thislen; 8291da177e4SLinus Torvalds len -= thislen; 8301da177e4SLinus Torvalds buf += thislen; 8311da177e4SLinus Torvalds 8321da177e4SLinus Torvalds ofs = 0; 8331da177e4SLinus Torvalds chipnum++; 8341da177e4SLinus Torvalds } 8351da177e4SLinus Torvalds return ret; 8361da177e4SLinus Torvalds } 8371da177e4SLinus Torvalds 8381da177e4SLinus Torvalds 8391da177e4SLinus Torvalds static inline int do_read_secsi_onechip(struct map_info *map, struct flchip *chip, loff_t adr, size_t len, u_char *buf) 8401da177e4SLinus Torvalds { 8411da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 8421da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 8431da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 8441da177e4SLinus Torvalds 8451da177e4SLinus Torvalds retry: 84602b15e34STodd Poynor spin_lock(chip->mutex); 8471da177e4SLinus Torvalds 8481da177e4SLinus Torvalds if (chip->state != FL_READY){ 8491da177e4SLinus Torvalds #if 0 8501da177e4SLinus Torvalds printk(KERN_DEBUG "Waiting for chip to read, status = %d\n", chip->state); 8511da177e4SLinus Torvalds #endif 8521da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 8531da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 8541da177e4SLinus Torvalds 85502b15e34STodd Poynor spin_unlock(chip->mutex); 8561da177e4SLinus Torvalds 8571da177e4SLinus Torvalds schedule(); 8581da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 8591da177e4SLinus Torvalds #if 0 8601da177e4SLinus Torvalds if(signal_pending(current)) 8611da177e4SLinus Torvalds return -EINTR; 8621da177e4SLinus Torvalds #endif 8631da177e4SLinus Torvalds timeo = jiffies + HZ; 8641da177e4SLinus Torvalds 8651da177e4SLinus Torvalds goto retry; 8661da177e4SLinus Torvalds } 8671da177e4SLinus Torvalds 8681da177e4SLinus Torvalds adr += chip->start; 8691da177e4SLinus Torvalds 8701da177e4SLinus Torvalds chip->state = FL_READY; 8711da177e4SLinus Torvalds 8721da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 8731da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 8741da177e4SLinus Torvalds cfi_send_gen_cmd(0x88, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 8751da177e4SLinus Torvalds 8761da177e4SLinus Torvalds map_copy_from(map, buf, adr, len); 8771da177e4SLinus Torvalds 8781da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 8791da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 8801da177e4SLinus Torvalds cfi_send_gen_cmd(0x90, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 8811da177e4SLinus Torvalds cfi_send_gen_cmd(0x00, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 8821da177e4SLinus Torvalds 8831da177e4SLinus Torvalds wake_up(&chip->wq); 88402b15e34STodd Poynor spin_unlock(chip->mutex); 8851da177e4SLinus Torvalds 8861da177e4SLinus Torvalds return 0; 8871da177e4SLinus Torvalds } 8881da177e4SLinus Torvalds 8891da177e4SLinus Torvalds static int cfi_amdstd_secsi_read (struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf) 8901da177e4SLinus Torvalds { 8911da177e4SLinus Torvalds struct map_info *map = mtd->priv; 8921da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 8931da177e4SLinus Torvalds unsigned long ofs; 8941da177e4SLinus Torvalds int chipnum; 8951da177e4SLinus Torvalds int ret = 0; 8961da177e4SLinus Torvalds 8971da177e4SLinus Torvalds 8981da177e4SLinus Torvalds /* ofs: offset within the first chip that the first read should start */ 8991da177e4SLinus Torvalds 9001da177e4SLinus Torvalds /* 8 secsi bytes per chip */ 9011da177e4SLinus Torvalds chipnum=from>>3; 9021da177e4SLinus Torvalds ofs=from & 7; 9031da177e4SLinus Torvalds 9041da177e4SLinus Torvalds 9051da177e4SLinus Torvalds *retlen = 0; 9061da177e4SLinus Torvalds 9071da177e4SLinus Torvalds while (len) { 9081da177e4SLinus Torvalds unsigned long thislen; 9091da177e4SLinus Torvalds 9101da177e4SLinus Torvalds if (chipnum >= cfi->numchips) 9111da177e4SLinus Torvalds break; 9121da177e4SLinus Torvalds 9131da177e4SLinus Torvalds if ((len + ofs -1) >> 3) 9141da177e4SLinus Torvalds thislen = (1<<3) - ofs; 9151da177e4SLinus Torvalds else 9161da177e4SLinus Torvalds thislen = len; 9171da177e4SLinus Torvalds 9181da177e4SLinus Torvalds ret = do_read_secsi_onechip(map, &cfi->chips[chipnum], ofs, thislen, buf); 9191da177e4SLinus Torvalds if (ret) 9201da177e4SLinus Torvalds break; 9211da177e4SLinus Torvalds 9221da177e4SLinus Torvalds *retlen += thislen; 9231da177e4SLinus Torvalds len -= thislen; 9241da177e4SLinus Torvalds buf += thislen; 9251da177e4SLinus Torvalds 9261da177e4SLinus Torvalds ofs = 0; 9271da177e4SLinus Torvalds chipnum++; 9281da177e4SLinus Torvalds } 9291da177e4SLinus Torvalds return ret; 9301da177e4SLinus Torvalds } 9311da177e4SLinus Torvalds 9321da177e4SLinus Torvalds 93302b15e34STodd Poynor static int __xipram do_write_oneword(struct map_info *map, struct flchip *chip, unsigned long adr, map_word datum) 9341da177e4SLinus Torvalds { 9351da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 9361da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 9371da177e4SLinus Torvalds /* 9381da177e4SLinus Torvalds * We use a 1ms + 1 jiffies generic timeout for writes (most devices 9391da177e4SLinus Torvalds * have a max write time of a few hundreds usec). However, we should 9401da177e4SLinus Torvalds * use the maximum timeout value given by the chip at probe time 9411da177e4SLinus Torvalds * instead. Unfortunately, struct flchip does have a field for 9421da177e4SLinus Torvalds * maximum timeout, only for typical which can be far too short 9431da177e4SLinus Torvalds * depending of the conditions. The ' + 1' is to avoid having a 9441da177e4SLinus Torvalds * timeout of 0 jiffies if HZ is smaller than 1000. 9451da177e4SLinus Torvalds */ 9461da177e4SLinus Torvalds unsigned long uWriteTimeout = ( HZ / 1000 ) + 1; 9471da177e4SLinus Torvalds int ret = 0; 9481da177e4SLinus Torvalds map_word oldd; 9491da177e4SLinus Torvalds int retry_cnt = 0; 9501da177e4SLinus Torvalds 9511da177e4SLinus Torvalds adr += chip->start; 9521da177e4SLinus Torvalds 95302b15e34STodd Poynor spin_lock(chip->mutex); 9541da177e4SLinus Torvalds ret = get_chip(map, chip, adr, FL_WRITING); 9551da177e4SLinus Torvalds if (ret) { 95602b15e34STodd Poynor spin_unlock(chip->mutex); 9571da177e4SLinus Torvalds return ret; 9581da177e4SLinus Torvalds } 9591da177e4SLinus Torvalds 9601da177e4SLinus Torvalds DEBUG( MTD_DEBUG_LEVEL3, "MTD %s(): WRITE 0x%.8lx(0x%.8lx)\n", 9611da177e4SLinus Torvalds __func__, adr, datum.x[0] ); 9621da177e4SLinus Torvalds 9631da177e4SLinus Torvalds /* 9641da177e4SLinus Torvalds * Check for a NOP for the case when the datum to write is already 9651da177e4SLinus Torvalds * present - it saves time and works around buggy chips that corrupt 9661da177e4SLinus Torvalds * data at other locations when 0xff is written to a location that 9671da177e4SLinus Torvalds * already contains 0xff. 9681da177e4SLinus Torvalds */ 9691da177e4SLinus Torvalds oldd = map_read(map, adr); 9701da177e4SLinus Torvalds if (map_word_equal(map, oldd, datum)) { 9711da177e4SLinus Torvalds DEBUG( MTD_DEBUG_LEVEL3, "MTD %s(): NOP\n", 9721da177e4SLinus Torvalds __func__); 9731da177e4SLinus Torvalds goto op_done; 9741da177e4SLinus Torvalds } 9751da177e4SLinus Torvalds 97602b15e34STodd Poynor XIP_INVAL_CACHED_RANGE(map, adr, map_bankwidth(map)); 9771da177e4SLinus Torvalds ENABLE_VPP(map); 97802b15e34STodd Poynor xip_disable(map, chip, adr); 9791da177e4SLinus Torvalds retry: 9801da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 9811da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 9821da177e4SLinus Torvalds cfi_send_gen_cmd(0xA0, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 9831da177e4SLinus Torvalds map_write(map, datum, adr); 9841da177e4SLinus Torvalds chip->state = FL_WRITING; 9851da177e4SLinus Torvalds 98602b15e34STodd Poynor INVALIDATE_CACHE_UDELAY(map, chip, 98702b15e34STodd Poynor adr, map_bankwidth(map), 98802b15e34STodd Poynor chip->word_write_time); 9891da177e4SLinus Torvalds 9901da177e4SLinus Torvalds /* See comment above for timeout value. */ 9911da177e4SLinus Torvalds timeo = jiffies + uWriteTimeout; 9921da177e4SLinus Torvalds for (;;) { 9931da177e4SLinus Torvalds if (chip->state != FL_WRITING) { 9941da177e4SLinus Torvalds /* Someone's suspended the write. Sleep */ 9951da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 9961da177e4SLinus Torvalds 9971da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 9981da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 99902b15e34STodd Poynor spin_unlock(chip->mutex); 10001da177e4SLinus Torvalds schedule(); 10011da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 10021da177e4SLinus Torvalds timeo = jiffies + (HZ / 2); /* FIXME */ 100302b15e34STodd Poynor spin_lock(chip->mutex); 10041da177e4SLinus Torvalds continue; 10051da177e4SLinus Torvalds } 10061da177e4SLinus Torvalds 10071da177e4SLinus Torvalds if (chip_ready(map, adr)) 10081da177e4SLinus Torvalds break; 10091da177e4SLinus Torvalds 1010fb4a90bfSEric W. Biedermann if (time_after(jiffies, timeo)) { 101102b15e34STodd Poynor xip_enable(map, chip, adr); 1012fb4a90bfSEric W. Biedermann printk(KERN_WARNING "MTD %s(): software timeout\n", __func__); 101302b15e34STodd Poynor xip_disable(map, chip, adr); 1014fb4a90bfSEric W. Biedermann break; 1015fb4a90bfSEric W. Biedermann } 1016fb4a90bfSEric W. Biedermann 10171da177e4SLinus Torvalds /* Latency issues. Drop the lock, wait a while and retry */ 101802b15e34STodd Poynor UDELAY(map, chip, adr, 1); 10191da177e4SLinus Torvalds } 1020fb4a90bfSEric W. Biedermann /* Did we succeed? */ 1021fb4a90bfSEric W. Biedermann if (!chip_good(map, adr, datum)) { 10221da177e4SLinus Torvalds /* reset on all failures. */ 10231da177e4SLinus Torvalds map_write( map, CMD(0xF0), chip->start ); 10241da177e4SLinus Torvalds /* FIXME - should have reset delay before continuing */ 1025fb4a90bfSEric W. Biedermann 10261da177e4SLinus Torvalds if (++retry_cnt <= MAX_WORD_RETRIES) 10271da177e4SLinus Torvalds goto retry; 10281da177e4SLinus Torvalds 10291da177e4SLinus Torvalds ret = -EIO; 1030fb4a90bfSEric W. Biedermann } 103102b15e34STodd Poynor xip_enable(map, chip, adr); 10321da177e4SLinus Torvalds op_done: 10331da177e4SLinus Torvalds chip->state = FL_READY; 10341da177e4SLinus Torvalds put_chip(map, chip, adr); 103502b15e34STodd Poynor spin_unlock(chip->mutex); 10361da177e4SLinus Torvalds 10371da177e4SLinus Torvalds return ret; 10381da177e4SLinus Torvalds } 10391da177e4SLinus Torvalds 10401da177e4SLinus Torvalds 10411da177e4SLinus Torvalds static int cfi_amdstd_write_words(struct mtd_info *mtd, loff_t to, size_t len, 10421da177e4SLinus Torvalds size_t *retlen, const u_char *buf) 10431da177e4SLinus Torvalds { 10441da177e4SLinus Torvalds struct map_info *map = mtd->priv; 10451da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 10461da177e4SLinus Torvalds int ret = 0; 10471da177e4SLinus Torvalds int chipnum; 10481da177e4SLinus Torvalds unsigned long ofs, chipstart; 10491da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 10501da177e4SLinus Torvalds 10511da177e4SLinus Torvalds *retlen = 0; 10521da177e4SLinus Torvalds if (!len) 10531da177e4SLinus Torvalds return 0; 10541da177e4SLinus Torvalds 10551da177e4SLinus Torvalds chipnum = to >> cfi->chipshift; 10561da177e4SLinus Torvalds ofs = to - (chipnum << cfi->chipshift); 10571da177e4SLinus Torvalds chipstart = cfi->chips[chipnum].start; 10581da177e4SLinus Torvalds 10591da177e4SLinus Torvalds /* If it's not bus-aligned, do the first byte write */ 10601da177e4SLinus Torvalds if (ofs & (map_bankwidth(map)-1)) { 10611da177e4SLinus Torvalds unsigned long bus_ofs = ofs & ~(map_bankwidth(map)-1); 10621da177e4SLinus Torvalds int i = ofs - bus_ofs; 10631da177e4SLinus Torvalds int n = 0; 10641da177e4SLinus Torvalds map_word tmp_buf; 10651da177e4SLinus Torvalds 10661da177e4SLinus Torvalds retry: 106702b15e34STodd Poynor spin_lock(cfi->chips[chipnum].mutex); 10681da177e4SLinus Torvalds 10691da177e4SLinus Torvalds if (cfi->chips[chipnum].state != FL_READY) { 10701da177e4SLinus Torvalds #if 0 10711da177e4SLinus Torvalds printk(KERN_DEBUG "Waiting for chip to write, status = %d\n", cfi->chips[chipnum].state); 10721da177e4SLinus Torvalds #endif 10731da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 10741da177e4SLinus Torvalds add_wait_queue(&cfi->chips[chipnum].wq, &wait); 10751da177e4SLinus Torvalds 107602b15e34STodd Poynor spin_unlock(cfi->chips[chipnum].mutex); 10771da177e4SLinus Torvalds 10781da177e4SLinus Torvalds schedule(); 10791da177e4SLinus Torvalds remove_wait_queue(&cfi->chips[chipnum].wq, &wait); 10801da177e4SLinus Torvalds #if 0 10811da177e4SLinus Torvalds if(signal_pending(current)) 10821da177e4SLinus Torvalds return -EINTR; 10831da177e4SLinus Torvalds #endif 10841da177e4SLinus Torvalds goto retry; 10851da177e4SLinus Torvalds } 10861da177e4SLinus Torvalds 10871da177e4SLinus Torvalds /* Load 'tmp_buf' with old contents of flash */ 10881da177e4SLinus Torvalds tmp_buf = map_read(map, bus_ofs+chipstart); 10891da177e4SLinus Torvalds 109002b15e34STodd Poynor spin_unlock(cfi->chips[chipnum].mutex); 10911da177e4SLinus Torvalds 10921da177e4SLinus Torvalds /* Number of bytes to copy from buffer */ 10931da177e4SLinus Torvalds n = min_t(int, len, map_bankwidth(map)-i); 10941da177e4SLinus Torvalds 10951da177e4SLinus Torvalds tmp_buf = map_word_load_partial(map, tmp_buf, buf, i, n); 10961da177e4SLinus Torvalds 10971da177e4SLinus Torvalds ret = do_write_oneword(map, &cfi->chips[chipnum], 10981da177e4SLinus Torvalds bus_ofs, tmp_buf); 10991da177e4SLinus Torvalds if (ret) 11001da177e4SLinus Torvalds return ret; 11011da177e4SLinus Torvalds 11021da177e4SLinus Torvalds ofs += n; 11031da177e4SLinus Torvalds buf += n; 11041da177e4SLinus Torvalds (*retlen) += n; 11051da177e4SLinus Torvalds len -= n; 11061da177e4SLinus Torvalds 11071da177e4SLinus Torvalds if (ofs >> cfi->chipshift) { 11081da177e4SLinus Torvalds chipnum ++; 11091da177e4SLinus Torvalds ofs = 0; 11101da177e4SLinus Torvalds if (chipnum == cfi->numchips) 11111da177e4SLinus Torvalds return 0; 11121da177e4SLinus Torvalds } 11131da177e4SLinus Torvalds } 11141da177e4SLinus Torvalds 11151da177e4SLinus Torvalds /* We are now aligned, write as much as possible */ 11161da177e4SLinus Torvalds while(len >= map_bankwidth(map)) { 11171da177e4SLinus Torvalds map_word datum; 11181da177e4SLinus Torvalds 11191da177e4SLinus Torvalds datum = map_word_load(map, buf); 11201da177e4SLinus Torvalds 11211da177e4SLinus Torvalds ret = do_write_oneword(map, &cfi->chips[chipnum], 11221da177e4SLinus Torvalds ofs, datum); 11231da177e4SLinus Torvalds if (ret) 11241da177e4SLinus Torvalds return ret; 11251da177e4SLinus Torvalds 11261da177e4SLinus Torvalds ofs += map_bankwidth(map); 11271da177e4SLinus Torvalds buf += map_bankwidth(map); 11281da177e4SLinus Torvalds (*retlen) += map_bankwidth(map); 11291da177e4SLinus Torvalds len -= map_bankwidth(map); 11301da177e4SLinus Torvalds 11311da177e4SLinus Torvalds if (ofs >> cfi->chipshift) { 11321da177e4SLinus Torvalds chipnum ++; 11331da177e4SLinus Torvalds ofs = 0; 11341da177e4SLinus Torvalds if (chipnum == cfi->numchips) 11351da177e4SLinus Torvalds return 0; 11361da177e4SLinus Torvalds chipstart = cfi->chips[chipnum].start; 11371da177e4SLinus Torvalds } 11381da177e4SLinus Torvalds } 11391da177e4SLinus Torvalds 11401da177e4SLinus Torvalds /* Write the trailing bytes if any */ 11411da177e4SLinus Torvalds if (len & (map_bankwidth(map)-1)) { 11421da177e4SLinus Torvalds map_word tmp_buf; 11431da177e4SLinus Torvalds 11441da177e4SLinus Torvalds retry1: 114502b15e34STodd Poynor spin_lock(cfi->chips[chipnum].mutex); 11461da177e4SLinus Torvalds 11471da177e4SLinus Torvalds if (cfi->chips[chipnum].state != FL_READY) { 11481da177e4SLinus Torvalds #if 0 11491da177e4SLinus Torvalds printk(KERN_DEBUG "Waiting for chip to write, status = %d\n", cfi->chips[chipnum].state); 11501da177e4SLinus Torvalds #endif 11511da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 11521da177e4SLinus Torvalds add_wait_queue(&cfi->chips[chipnum].wq, &wait); 11531da177e4SLinus Torvalds 115402b15e34STodd Poynor spin_unlock(cfi->chips[chipnum].mutex); 11551da177e4SLinus Torvalds 11561da177e4SLinus Torvalds schedule(); 11571da177e4SLinus Torvalds remove_wait_queue(&cfi->chips[chipnum].wq, &wait); 11581da177e4SLinus Torvalds #if 0 11591da177e4SLinus Torvalds if(signal_pending(current)) 11601da177e4SLinus Torvalds return -EINTR; 11611da177e4SLinus Torvalds #endif 11621da177e4SLinus Torvalds goto retry1; 11631da177e4SLinus Torvalds } 11641da177e4SLinus Torvalds 11651da177e4SLinus Torvalds tmp_buf = map_read(map, ofs + chipstart); 11661da177e4SLinus Torvalds 116702b15e34STodd Poynor spin_unlock(cfi->chips[chipnum].mutex); 11681da177e4SLinus Torvalds 11691da177e4SLinus Torvalds tmp_buf = map_word_load_partial(map, tmp_buf, buf, 0, len); 11701da177e4SLinus Torvalds 11711da177e4SLinus Torvalds ret = do_write_oneword(map, &cfi->chips[chipnum], 11721da177e4SLinus Torvalds ofs, tmp_buf); 11731da177e4SLinus Torvalds if (ret) 11741da177e4SLinus Torvalds return ret; 11751da177e4SLinus Torvalds 11761da177e4SLinus Torvalds (*retlen) += len; 11771da177e4SLinus Torvalds } 11781da177e4SLinus Torvalds 11791da177e4SLinus Torvalds return 0; 11801da177e4SLinus Torvalds } 11811da177e4SLinus Torvalds 11821da177e4SLinus Torvalds 11831da177e4SLinus Torvalds /* 11841da177e4SLinus Torvalds * FIXME: interleaved mode not tested, and probably not supported! 11851da177e4SLinus Torvalds */ 118602b15e34STodd Poynor static int __xipram do_write_buffer(struct map_info *map, struct flchip *chip, 118702b15e34STodd Poynor unsigned long adr, const u_char *buf, 118802b15e34STodd Poynor int len) 11891da177e4SLinus Torvalds { 11901da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 11911da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 11921da177e4SLinus Torvalds /* see comments in do_write_oneword() regarding uWriteTimeo. */ 11931da177e4SLinus Torvalds unsigned long uWriteTimeout = ( HZ / 1000 ) + 1; 11941da177e4SLinus Torvalds int ret = -EIO; 11951da177e4SLinus Torvalds unsigned long cmd_adr; 11961da177e4SLinus Torvalds int z, words; 11971da177e4SLinus Torvalds map_word datum; 11981da177e4SLinus Torvalds 11991da177e4SLinus Torvalds adr += chip->start; 12001da177e4SLinus Torvalds cmd_adr = adr; 12011da177e4SLinus Torvalds 120202b15e34STodd Poynor spin_lock(chip->mutex); 12031da177e4SLinus Torvalds ret = get_chip(map, chip, adr, FL_WRITING); 12041da177e4SLinus Torvalds if (ret) { 120502b15e34STodd Poynor spin_unlock(chip->mutex); 12061da177e4SLinus Torvalds return ret; 12071da177e4SLinus Torvalds } 12081da177e4SLinus Torvalds 12091da177e4SLinus Torvalds datum = map_word_load(map, buf); 12101da177e4SLinus Torvalds 12111da177e4SLinus Torvalds DEBUG( MTD_DEBUG_LEVEL3, "MTD %s(): WRITE 0x%.8lx(0x%.8lx)\n", 12121da177e4SLinus Torvalds __func__, adr, datum.x[0] ); 12131da177e4SLinus Torvalds 121402b15e34STodd Poynor XIP_INVAL_CACHED_RANGE(map, adr, len); 12151da177e4SLinus Torvalds ENABLE_VPP(map); 121602b15e34STodd Poynor xip_disable(map, chip, cmd_adr); 121702b15e34STodd Poynor 12181da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 12191da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 12201da177e4SLinus Torvalds //cfi_send_gen_cmd(0xA0, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 12211da177e4SLinus Torvalds 12221da177e4SLinus Torvalds /* Write Buffer Load */ 12231da177e4SLinus Torvalds map_write(map, CMD(0x25), cmd_adr); 12241da177e4SLinus Torvalds 12251da177e4SLinus Torvalds chip->state = FL_WRITING_TO_BUFFER; 12261da177e4SLinus Torvalds 12271da177e4SLinus Torvalds /* Write length of data to come */ 12281da177e4SLinus Torvalds words = len / map_bankwidth(map); 12291da177e4SLinus Torvalds map_write(map, CMD(words - 1), cmd_adr); 12301da177e4SLinus Torvalds /* Write data */ 12311da177e4SLinus Torvalds z = 0; 12321da177e4SLinus Torvalds while(z < words * map_bankwidth(map)) { 12331da177e4SLinus Torvalds datum = map_word_load(map, buf); 12341da177e4SLinus Torvalds map_write(map, datum, adr + z); 12351da177e4SLinus Torvalds 12361da177e4SLinus Torvalds z += map_bankwidth(map); 12371da177e4SLinus Torvalds buf += map_bankwidth(map); 12381da177e4SLinus Torvalds } 12391da177e4SLinus Torvalds z -= map_bankwidth(map); 12401da177e4SLinus Torvalds 12411da177e4SLinus Torvalds adr += z; 12421da177e4SLinus Torvalds 12431da177e4SLinus Torvalds /* Write Buffer Program Confirm: GO GO GO */ 12441da177e4SLinus Torvalds map_write(map, CMD(0x29), cmd_adr); 12451da177e4SLinus Torvalds chip->state = FL_WRITING; 12461da177e4SLinus Torvalds 124702b15e34STodd Poynor INVALIDATE_CACHE_UDELAY(map, chip, 124802b15e34STodd Poynor adr, map_bankwidth(map), 124902b15e34STodd Poynor chip->word_write_time); 12501da177e4SLinus Torvalds 12511da177e4SLinus Torvalds timeo = jiffies + uWriteTimeout; 12521da177e4SLinus Torvalds 12531da177e4SLinus Torvalds for (;;) { 12541da177e4SLinus Torvalds if (chip->state != FL_WRITING) { 12551da177e4SLinus Torvalds /* Someone's suspended the write. Sleep */ 12561da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 12571da177e4SLinus Torvalds 12581da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 12591da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 126002b15e34STodd Poynor spin_unlock(chip->mutex); 12611da177e4SLinus Torvalds schedule(); 12621da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 12631da177e4SLinus Torvalds timeo = jiffies + (HZ / 2); /* FIXME */ 126402b15e34STodd Poynor spin_lock(chip->mutex); 12651da177e4SLinus Torvalds continue; 12661da177e4SLinus Torvalds } 12671da177e4SLinus Torvalds 126802b15e34STodd Poynor if (chip_ready(map, adr)) { 126902b15e34STodd Poynor xip_enable(map, chip, adr); 12701da177e4SLinus Torvalds goto op_done; 127102b15e34STodd Poynor } 12721da177e4SLinus Torvalds 12731da177e4SLinus Torvalds if( time_after(jiffies, timeo)) 12741da177e4SLinus Torvalds break; 12751da177e4SLinus Torvalds 12761da177e4SLinus Torvalds /* Latency issues. Drop the lock, wait a while and retry */ 127702b15e34STodd Poynor UDELAY(map, chip, adr, 1); 12781da177e4SLinus Torvalds } 12791da177e4SLinus Torvalds 12801da177e4SLinus Torvalds /* reset on all failures. */ 12811da177e4SLinus Torvalds map_write( map, CMD(0xF0), chip->start ); 128202b15e34STodd Poynor xip_enable(map, chip, adr); 12831da177e4SLinus Torvalds /* FIXME - should have reset delay before continuing */ 12841da177e4SLinus Torvalds 128502b15e34STodd Poynor printk(KERN_WARNING "MTD %s(): software timeout\n", 128602b15e34STodd Poynor __func__ ); 128702b15e34STodd Poynor 12881da177e4SLinus Torvalds ret = -EIO; 12891da177e4SLinus Torvalds op_done: 12901da177e4SLinus Torvalds chip->state = FL_READY; 12911da177e4SLinus Torvalds put_chip(map, chip, adr); 129202b15e34STodd Poynor spin_unlock(chip->mutex); 12931da177e4SLinus Torvalds 12941da177e4SLinus Torvalds return ret; 12951da177e4SLinus Torvalds } 12961da177e4SLinus Torvalds 12971da177e4SLinus Torvalds 12981da177e4SLinus Torvalds static int cfi_amdstd_write_buffers(struct mtd_info *mtd, loff_t to, size_t len, 12991da177e4SLinus Torvalds size_t *retlen, const u_char *buf) 13001da177e4SLinus Torvalds { 13011da177e4SLinus Torvalds struct map_info *map = mtd->priv; 13021da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 13031da177e4SLinus Torvalds int wbufsize = cfi_interleave(cfi) << cfi->cfiq->MaxBufWriteSize; 13041da177e4SLinus Torvalds int ret = 0; 13051da177e4SLinus Torvalds int chipnum; 13061da177e4SLinus Torvalds unsigned long ofs; 13071da177e4SLinus Torvalds 13081da177e4SLinus Torvalds *retlen = 0; 13091da177e4SLinus Torvalds if (!len) 13101da177e4SLinus Torvalds return 0; 13111da177e4SLinus Torvalds 13121da177e4SLinus Torvalds chipnum = to >> cfi->chipshift; 13131da177e4SLinus Torvalds ofs = to - (chipnum << cfi->chipshift); 13141da177e4SLinus Torvalds 13151da177e4SLinus Torvalds /* If it's not bus-aligned, do the first word write */ 13161da177e4SLinus Torvalds if (ofs & (map_bankwidth(map)-1)) { 13171da177e4SLinus Torvalds size_t local_len = (-ofs)&(map_bankwidth(map)-1); 13181da177e4SLinus Torvalds if (local_len > len) 13191da177e4SLinus Torvalds local_len = len; 13201da177e4SLinus Torvalds ret = cfi_amdstd_write_words(mtd, ofs + (chipnum<<cfi->chipshift), 13211da177e4SLinus Torvalds local_len, retlen, buf); 13221da177e4SLinus Torvalds if (ret) 13231da177e4SLinus Torvalds return ret; 13241da177e4SLinus Torvalds ofs += local_len; 13251da177e4SLinus Torvalds buf += local_len; 13261da177e4SLinus Torvalds len -= local_len; 13271da177e4SLinus Torvalds 13281da177e4SLinus Torvalds if (ofs >> cfi->chipshift) { 13291da177e4SLinus Torvalds chipnum ++; 13301da177e4SLinus Torvalds ofs = 0; 13311da177e4SLinus Torvalds if (chipnum == cfi->numchips) 13321da177e4SLinus Torvalds return 0; 13331da177e4SLinus Torvalds } 13341da177e4SLinus Torvalds } 13351da177e4SLinus Torvalds 13361da177e4SLinus Torvalds /* Write buffer is worth it only if more than one word to write... */ 13371da177e4SLinus Torvalds while (len >= map_bankwidth(map) * 2) { 13381da177e4SLinus Torvalds /* We must not cross write block boundaries */ 13391da177e4SLinus Torvalds int size = wbufsize - (ofs & (wbufsize-1)); 13401da177e4SLinus Torvalds 13411da177e4SLinus Torvalds if (size > len) 13421da177e4SLinus Torvalds size = len; 13431da177e4SLinus Torvalds if (size % map_bankwidth(map)) 13441da177e4SLinus Torvalds size -= size % map_bankwidth(map); 13451da177e4SLinus Torvalds 13461da177e4SLinus Torvalds ret = do_write_buffer(map, &cfi->chips[chipnum], 13471da177e4SLinus Torvalds ofs, buf, size); 13481da177e4SLinus Torvalds if (ret) 13491da177e4SLinus Torvalds return ret; 13501da177e4SLinus Torvalds 13511da177e4SLinus Torvalds ofs += size; 13521da177e4SLinus Torvalds buf += size; 13531da177e4SLinus Torvalds (*retlen) += size; 13541da177e4SLinus Torvalds len -= size; 13551da177e4SLinus Torvalds 13561da177e4SLinus Torvalds if (ofs >> cfi->chipshift) { 13571da177e4SLinus Torvalds chipnum ++; 13581da177e4SLinus Torvalds ofs = 0; 13591da177e4SLinus Torvalds if (chipnum == cfi->numchips) 13601da177e4SLinus Torvalds return 0; 13611da177e4SLinus Torvalds } 13621da177e4SLinus Torvalds } 13631da177e4SLinus Torvalds 13641da177e4SLinus Torvalds if (len) { 13651da177e4SLinus Torvalds size_t retlen_dregs = 0; 13661da177e4SLinus Torvalds 13671da177e4SLinus Torvalds ret = cfi_amdstd_write_words(mtd, ofs + (chipnum<<cfi->chipshift), 13681da177e4SLinus Torvalds len, &retlen_dregs, buf); 13691da177e4SLinus Torvalds 13701da177e4SLinus Torvalds *retlen += retlen_dregs; 13711da177e4SLinus Torvalds return ret; 13721da177e4SLinus Torvalds } 13731da177e4SLinus Torvalds 13741da177e4SLinus Torvalds return 0; 13751da177e4SLinus Torvalds } 13761da177e4SLinus Torvalds 13771da177e4SLinus Torvalds 13781da177e4SLinus Torvalds /* 13791da177e4SLinus Torvalds * Handle devices with one erase region, that only implement 13801da177e4SLinus Torvalds * the chip erase command. 13811da177e4SLinus Torvalds */ 138202b15e34STodd Poynor static int __xipram do_erase_chip(struct map_info *map, struct flchip *chip) 13831da177e4SLinus Torvalds { 13841da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 13851da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 13861da177e4SLinus Torvalds unsigned long int adr; 13871da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 13881da177e4SLinus Torvalds int ret = 0; 13891da177e4SLinus Torvalds 13901da177e4SLinus Torvalds adr = cfi->addr_unlock1; 13911da177e4SLinus Torvalds 139202b15e34STodd Poynor spin_lock(chip->mutex); 13931da177e4SLinus Torvalds ret = get_chip(map, chip, adr, FL_WRITING); 13941da177e4SLinus Torvalds if (ret) { 139502b15e34STodd Poynor spin_unlock(chip->mutex); 13961da177e4SLinus Torvalds return ret; 13971da177e4SLinus Torvalds } 13981da177e4SLinus Torvalds 13991da177e4SLinus Torvalds DEBUG( MTD_DEBUG_LEVEL3, "MTD %s(): ERASE 0x%.8lx\n", 14001da177e4SLinus Torvalds __func__, chip->start ); 14011da177e4SLinus Torvalds 140202b15e34STodd Poynor XIP_INVAL_CACHED_RANGE(map, adr, map->size); 14031da177e4SLinus Torvalds ENABLE_VPP(map); 140402b15e34STodd Poynor xip_disable(map, chip, adr); 140502b15e34STodd Poynor 14061da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 14071da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 14081da177e4SLinus Torvalds cfi_send_gen_cmd(0x80, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 14091da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 14101da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 14111da177e4SLinus Torvalds cfi_send_gen_cmd(0x10, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 14121da177e4SLinus Torvalds 14131da177e4SLinus Torvalds chip->state = FL_ERASING; 14141da177e4SLinus Torvalds chip->erase_suspended = 0; 14151da177e4SLinus Torvalds chip->in_progress_block_addr = adr; 14161da177e4SLinus Torvalds 141702b15e34STodd Poynor INVALIDATE_CACHE_UDELAY(map, chip, 141802b15e34STodd Poynor adr, map->size, 141902b15e34STodd Poynor chip->erase_time*500); 14201da177e4SLinus Torvalds 14211da177e4SLinus Torvalds timeo = jiffies + (HZ*20); 14221da177e4SLinus Torvalds 14231da177e4SLinus Torvalds for (;;) { 14241da177e4SLinus Torvalds if (chip->state != FL_ERASING) { 14251da177e4SLinus Torvalds /* Someone's suspended the erase. Sleep */ 14261da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 14271da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 142802b15e34STodd Poynor spin_unlock(chip->mutex); 14291da177e4SLinus Torvalds schedule(); 14301da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 143102b15e34STodd Poynor spin_lock(chip->mutex); 14321da177e4SLinus Torvalds continue; 14331da177e4SLinus Torvalds } 14341da177e4SLinus Torvalds if (chip->erase_suspended) { 14351da177e4SLinus Torvalds /* This erase was suspended and resumed. 14361da177e4SLinus Torvalds Adjust the timeout */ 14371da177e4SLinus Torvalds timeo = jiffies + (HZ*20); /* FIXME */ 14381da177e4SLinus Torvalds chip->erase_suspended = 0; 14391da177e4SLinus Torvalds } 14401da177e4SLinus Torvalds 14411da177e4SLinus Torvalds if (chip_ready(map, adr)) 14421da177e4SLinus Torvalds break; 14431da177e4SLinus Torvalds 1444fb4a90bfSEric W. Biedermann if (time_after(jiffies, timeo)) { 1445fb4a90bfSEric W. Biedermann printk(KERN_WARNING "MTD %s(): software timeout\n", 1446fb4a90bfSEric W. Biedermann __func__ ); 1447fb4a90bfSEric W. Biedermann break; 1448fb4a90bfSEric W. Biedermann } 1449fb4a90bfSEric W. Biedermann 14501da177e4SLinus Torvalds /* Latency issues. Drop the lock, wait a while and retry */ 145102b15e34STodd Poynor UDELAY(map, chip, adr, 1000000/HZ); 14521da177e4SLinus Torvalds } 1453fb4a90bfSEric W. Biedermann /* Did we succeed? */ 1454fb4a90bfSEric W. Biedermann if (!chip_good(map, adr, map_word_ff(map))) { 14551da177e4SLinus Torvalds /* reset on all failures. */ 14561da177e4SLinus Torvalds map_write( map, CMD(0xF0), chip->start ); 14571da177e4SLinus Torvalds /* FIXME - should have reset delay before continuing */ 14581da177e4SLinus Torvalds 14591da177e4SLinus Torvalds ret = -EIO; 1460fb4a90bfSEric W. Biedermann } 1461fb4a90bfSEric W. Biedermann 14621da177e4SLinus Torvalds chip->state = FL_READY; 146302b15e34STodd Poynor xip_enable(map, chip, adr); 14641da177e4SLinus Torvalds put_chip(map, chip, adr); 146502b15e34STodd Poynor spin_unlock(chip->mutex); 14661da177e4SLinus Torvalds 14671da177e4SLinus Torvalds return ret; 14681da177e4SLinus Torvalds } 14691da177e4SLinus Torvalds 14701da177e4SLinus Torvalds 147102b15e34STodd Poynor static int __xipram do_erase_oneblock(struct map_info *map, struct flchip *chip, unsigned long adr, int len, void *thunk) 14721da177e4SLinus Torvalds { 14731da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 14741da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 14751da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 14761da177e4SLinus Torvalds int ret = 0; 14771da177e4SLinus Torvalds 14781da177e4SLinus Torvalds adr += chip->start; 14791da177e4SLinus Torvalds 148002b15e34STodd Poynor spin_lock(chip->mutex); 14811da177e4SLinus Torvalds ret = get_chip(map, chip, adr, FL_ERASING); 14821da177e4SLinus Torvalds if (ret) { 148302b15e34STodd Poynor spin_unlock(chip->mutex); 14841da177e4SLinus Torvalds return ret; 14851da177e4SLinus Torvalds } 14861da177e4SLinus Torvalds 14871da177e4SLinus Torvalds DEBUG( MTD_DEBUG_LEVEL3, "MTD %s(): ERASE 0x%.8lx\n", 14881da177e4SLinus Torvalds __func__, adr ); 14891da177e4SLinus Torvalds 149002b15e34STodd Poynor XIP_INVAL_CACHED_RANGE(map, adr, len); 14911da177e4SLinus Torvalds ENABLE_VPP(map); 149202b15e34STodd Poynor xip_disable(map, chip, adr); 149302b15e34STodd Poynor 14941da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 14951da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 14961da177e4SLinus Torvalds cfi_send_gen_cmd(0x80, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 14971da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 14981da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 14991da177e4SLinus Torvalds map_write(map, CMD(0x30), adr); 15001da177e4SLinus Torvalds 15011da177e4SLinus Torvalds chip->state = FL_ERASING; 15021da177e4SLinus Torvalds chip->erase_suspended = 0; 15031da177e4SLinus Torvalds chip->in_progress_block_addr = adr; 15041da177e4SLinus Torvalds 150502b15e34STodd Poynor INVALIDATE_CACHE_UDELAY(map, chip, 150602b15e34STodd Poynor adr, len, 150702b15e34STodd Poynor chip->erase_time*500); 15081da177e4SLinus Torvalds 15091da177e4SLinus Torvalds timeo = jiffies + (HZ*20); 15101da177e4SLinus Torvalds 15111da177e4SLinus Torvalds for (;;) { 15121da177e4SLinus Torvalds if (chip->state != FL_ERASING) { 15131da177e4SLinus Torvalds /* Someone's suspended the erase. Sleep */ 15141da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 15151da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 151602b15e34STodd Poynor spin_unlock(chip->mutex); 15171da177e4SLinus Torvalds schedule(); 15181da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 151902b15e34STodd Poynor spin_lock(chip->mutex); 15201da177e4SLinus Torvalds continue; 15211da177e4SLinus Torvalds } 15221da177e4SLinus Torvalds if (chip->erase_suspended) { 15231da177e4SLinus Torvalds /* This erase was suspended and resumed. 15241da177e4SLinus Torvalds Adjust the timeout */ 15251da177e4SLinus Torvalds timeo = jiffies + (HZ*20); /* FIXME */ 15261da177e4SLinus Torvalds chip->erase_suspended = 0; 15271da177e4SLinus Torvalds } 15281da177e4SLinus Torvalds 152902b15e34STodd Poynor if (chip_ready(map, adr)) { 153002b15e34STodd Poynor xip_enable(map, chip, adr); 15311da177e4SLinus Torvalds break; 153202b15e34STodd Poynor } 15331da177e4SLinus Torvalds 1534fb4a90bfSEric W. Biedermann if (time_after(jiffies, timeo)) { 153502b15e34STodd Poynor xip_enable(map, chip, adr); 1536fb4a90bfSEric W. Biedermann printk(KERN_WARNING "MTD %s(): software timeout\n", 1537fb4a90bfSEric W. Biedermann __func__ ); 1538fb4a90bfSEric W. Biedermann break; 1539fb4a90bfSEric W. Biedermann } 1540fb4a90bfSEric W. Biedermann 15411da177e4SLinus Torvalds /* Latency issues. Drop the lock, wait a while and retry */ 154202b15e34STodd Poynor UDELAY(map, chip, adr, 1000000/HZ); 15431da177e4SLinus Torvalds } 1544fb4a90bfSEric W. Biedermann /* Did we succeed? */ 154522fd9a87SThomas Gleixner if (!chip_good(map, adr, map_word_ff(map))) { 15461da177e4SLinus Torvalds /* reset on all failures. */ 15471da177e4SLinus Torvalds map_write( map, CMD(0xF0), chip->start ); 15481da177e4SLinus Torvalds /* FIXME - should have reset delay before continuing */ 15491da177e4SLinus Torvalds 15501da177e4SLinus Torvalds ret = -EIO; 1551fb4a90bfSEric W. Biedermann } 1552fb4a90bfSEric W. Biedermann 15531da177e4SLinus Torvalds chip->state = FL_READY; 15541da177e4SLinus Torvalds put_chip(map, chip, adr); 155502b15e34STodd Poynor spin_unlock(chip->mutex); 15561da177e4SLinus Torvalds return ret; 15571da177e4SLinus Torvalds } 15581da177e4SLinus Torvalds 15591da177e4SLinus Torvalds 15601da177e4SLinus Torvalds int cfi_amdstd_erase_varsize(struct mtd_info *mtd, struct erase_info *instr) 15611da177e4SLinus Torvalds { 15621da177e4SLinus Torvalds unsigned long ofs, len; 15631da177e4SLinus Torvalds int ret; 15641da177e4SLinus Torvalds 15651da177e4SLinus Torvalds ofs = instr->addr; 15661da177e4SLinus Torvalds len = instr->len; 15671da177e4SLinus Torvalds 15681da177e4SLinus Torvalds ret = cfi_varsize_frob(mtd, do_erase_oneblock, ofs, len, NULL); 15691da177e4SLinus Torvalds if (ret) 15701da177e4SLinus Torvalds return ret; 15711da177e4SLinus Torvalds 15721da177e4SLinus Torvalds instr->state = MTD_ERASE_DONE; 15731da177e4SLinus Torvalds mtd_erase_callback(instr); 15741da177e4SLinus Torvalds 15751da177e4SLinus Torvalds return 0; 15761da177e4SLinus Torvalds } 15771da177e4SLinus Torvalds 15781da177e4SLinus Torvalds 15791da177e4SLinus Torvalds static int cfi_amdstd_erase_chip(struct mtd_info *mtd, struct erase_info *instr) 15801da177e4SLinus Torvalds { 15811da177e4SLinus Torvalds struct map_info *map = mtd->priv; 15821da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 15831da177e4SLinus Torvalds int ret = 0; 15841da177e4SLinus Torvalds 15851da177e4SLinus Torvalds if (instr->addr != 0) 15861da177e4SLinus Torvalds return -EINVAL; 15871da177e4SLinus Torvalds 15881da177e4SLinus Torvalds if (instr->len != mtd->size) 15891da177e4SLinus Torvalds return -EINVAL; 15901da177e4SLinus Torvalds 15911da177e4SLinus Torvalds ret = do_erase_chip(map, &cfi->chips[0]); 15921da177e4SLinus Torvalds if (ret) 15931da177e4SLinus Torvalds return ret; 15941da177e4SLinus Torvalds 15951da177e4SLinus Torvalds instr->state = MTD_ERASE_DONE; 15961da177e4SLinus Torvalds mtd_erase_callback(instr); 15971da177e4SLinus Torvalds 15981da177e4SLinus Torvalds return 0; 15991da177e4SLinus Torvalds } 16001da177e4SLinus Torvalds 16011da177e4SLinus Torvalds 16021da177e4SLinus Torvalds static void cfi_amdstd_sync (struct mtd_info *mtd) 16031da177e4SLinus Torvalds { 16041da177e4SLinus Torvalds struct map_info *map = mtd->priv; 16051da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 16061da177e4SLinus Torvalds int i; 16071da177e4SLinus Torvalds struct flchip *chip; 16081da177e4SLinus Torvalds int ret = 0; 16091da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 16101da177e4SLinus Torvalds 16111da177e4SLinus Torvalds for (i=0; !ret && i<cfi->numchips; i++) { 16121da177e4SLinus Torvalds chip = &cfi->chips[i]; 16131da177e4SLinus Torvalds 16141da177e4SLinus Torvalds retry: 161502b15e34STodd Poynor spin_lock(chip->mutex); 16161da177e4SLinus Torvalds 16171da177e4SLinus Torvalds switch(chip->state) { 16181da177e4SLinus Torvalds case FL_READY: 16191da177e4SLinus Torvalds case FL_STATUS: 16201da177e4SLinus Torvalds case FL_CFI_QUERY: 16211da177e4SLinus Torvalds case FL_JEDEC_QUERY: 16221da177e4SLinus Torvalds chip->oldstate = chip->state; 16231da177e4SLinus Torvalds chip->state = FL_SYNCING; 16241da177e4SLinus Torvalds /* No need to wake_up() on this state change - 16251da177e4SLinus Torvalds * as the whole point is that nobody can do anything 16261da177e4SLinus Torvalds * with the chip now anyway. 16271da177e4SLinus Torvalds */ 16281da177e4SLinus Torvalds case FL_SYNCING: 162902b15e34STodd Poynor spin_unlock(chip->mutex); 16301da177e4SLinus Torvalds break; 16311da177e4SLinus Torvalds 16321da177e4SLinus Torvalds default: 16331da177e4SLinus Torvalds /* Not an idle state */ 16341da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 16351da177e4SLinus Torvalds 163602b15e34STodd Poynor spin_unlock(chip->mutex); 16371da177e4SLinus Torvalds 16381da177e4SLinus Torvalds schedule(); 16391da177e4SLinus Torvalds 16401da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 16411da177e4SLinus Torvalds 16421da177e4SLinus Torvalds goto retry; 16431da177e4SLinus Torvalds } 16441da177e4SLinus Torvalds } 16451da177e4SLinus Torvalds 16461da177e4SLinus Torvalds /* Unlock the chips again */ 16471da177e4SLinus Torvalds 16481da177e4SLinus Torvalds for (i--; i >=0; i--) { 16491da177e4SLinus Torvalds chip = &cfi->chips[i]; 16501da177e4SLinus Torvalds 165102b15e34STodd Poynor spin_lock(chip->mutex); 16521da177e4SLinus Torvalds 16531da177e4SLinus Torvalds if (chip->state == FL_SYNCING) { 16541da177e4SLinus Torvalds chip->state = chip->oldstate; 16551da177e4SLinus Torvalds wake_up(&chip->wq); 16561da177e4SLinus Torvalds } 165702b15e34STodd Poynor spin_unlock(chip->mutex); 16581da177e4SLinus Torvalds } 16591da177e4SLinus Torvalds } 16601da177e4SLinus Torvalds 16611da177e4SLinus Torvalds 16621da177e4SLinus Torvalds static int cfi_amdstd_suspend(struct mtd_info *mtd) 16631da177e4SLinus Torvalds { 16641da177e4SLinus Torvalds struct map_info *map = mtd->priv; 16651da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 16661da177e4SLinus Torvalds int i; 16671da177e4SLinus Torvalds struct flchip *chip; 16681da177e4SLinus Torvalds int ret = 0; 16691da177e4SLinus Torvalds 16701da177e4SLinus Torvalds for (i=0; !ret && i<cfi->numchips; i++) { 16711da177e4SLinus Torvalds chip = &cfi->chips[i]; 16721da177e4SLinus Torvalds 167302b15e34STodd Poynor spin_lock(chip->mutex); 16741da177e4SLinus Torvalds 16751da177e4SLinus Torvalds switch(chip->state) { 16761da177e4SLinus Torvalds case FL_READY: 16771da177e4SLinus Torvalds case FL_STATUS: 16781da177e4SLinus Torvalds case FL_CFI_QUERY: 16791da177e4SLinus Torvalds case FL_JEDEC_QUERY: 16801da177e4SLinus Torvalds chip->oldstate = chip->state; 16811da177e4SLinus Torvalds chip->state = FL_PM_SUSPENDED; 16821da177e4SLinus Torvalds /* No need to wake_up() on this state change - 16831da177e4SLinus Torvalds * as the whole point is that nobody can do anything 16841da177e4SLinus Torvalds * with the chip now anyway. 16851da177e4SLinus Torvalds */ 16861da177e4SLinus Torvalds case FL_PM_SUSPENDED: 16871da177e4SLinus Torvalds break; 16881da177e4SLinus Torvalds 16891da177e4SLinus Torvalds default: 16901da177e4SLinus Torvalds ret = -EAGAIN; 16911da177e4SLinus Torvalds break; 16921da177e4SLinus Torvalds } 169302b15e34STodd Poynor spin_unlock(chip->mutex); 16941da177e4SLinus Torvalds } 16951da177e4SLinus Torvalds 16961da177e4SLinus Torvalds /* Unlock the chips again */ 16971da177e4SLinus Torvalds 16981da177e4SLinus Torvalds if (ret) { 16991da177e4SLinus Torvalds for (i--; i >=0; i--) { 17001da177e4SLinus Torvalds chip = &cfi->chips[i]; 17011da177e4SLinus Torvalds 170202b15e34STodd Poynor spin_lock(chip->mutex); 17031da177e4SLinus Torvalds 17041da177e4SLinus Torvalds if (chip->state == FL_PM_SUSPENDED) { 17051da177e4SLinus Torvalds chip->state = chip->oldstate; 17061da177e4SLinus Torvalds wake_up(&chip->wq); 17071da177e4SLinus Torvalds } 170802b15e34STodd Poynor spin_unlock(chip->mutex); 17091da177e4SLinus Torvalds } 17101da177e4SLinus Torvalds } 17111da177e4SLinus Torvalds 17121da177e4SLinus Torvalds return ret; 17131da177e4SLinus Torvalds } 17141da177e4SLinus Torvalds 17151da177e4SLinus Torvalds 17161da177e4SLinus Torvalds static void cfi_amdstd_resume(struct mtd_info *mtd) 17171da177e4SLinus Torvalds { 17181da177e4SLinus Torvalds struct map_info *map = mtd->priv; 17191da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 17201da177e4SLinus Torvalds int i; 17211da177e4SLinus Torvalds struct flchip *chip; 17221da177e4SLinus Torvalds 17231da177e4SLinus Torvalds for (i=0; i<cfi->numchips; i++) { 17241da177e4SLinus Torvalds 17251da177e4SLinus Torvalds chip = &cfi->chips[i]; 17261da177e4SLinus Torvalds 172702b15e34STodd Poynor spin_lock(chip->mutex); 17281da177e4SLinus Torvalds 17291da177e4SLinus Torvalds if (chip->state == FL_PM_SUSPENDED) { 17301da177e4SLinus Torvalds chip->state = FL_READY; 17311da177e4SLinus Torvalds map_write(map, CMD(0xF0), chip->start); 17321da177e4SLinus Torvalds wake_up(&chip->wq); 17331da177e4SLinus Torvalds } 17341da177e4SLinus Torvalds else 17351da177e4SLinus Torvalds printk(KERN_ERR "Argh. Chip not in PM_SUSPENDED state upon resume()\n"); 17361da177e4SLinus Torvalds 173702b15e34STodd Poynor spin_unlock(chip->mutex); 17381da177e4SLinus Torvalds } 17391da177e4SLinus Torvalds } 17401da177e4SLinus Torvalds 17411da177e4SLinus Torvalds static void cfi_amdstd_destroy(struct mtd_info *mtd) 17421da177e4SLinus Torvalds { 17431da177e4SLinus Torvalds struct map_info *map = mtd->priv; 17441da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 17451da177e4SLinus Torvalds kfree(cfi->cmdset_priv); 17461da177e4SLinus Torvalds kfree(cfi->cfiq); 17471da177e4SLinus Torvalds kfree(cfi); 17481da177e4SLinus Torvalds kfree(mtd->eraseregions); 17491da177e4SLinus Torvalds } 17501da177e4SLinus Torvalds 17511da177e4SLinus Torvalds static char im_name[]="cfi_cmdset_0002"; 17521da177e4SLinus Torvalds 17531da177e4SLinus Torvalds 17541da177e4SLinus Torvalds static int __init cfi_amdstd_init(void) 17551da177e4SLinus Torvalds { 17561da177e4SLinus Torvalds inter_module_register(im_name, THIS_MODULE, &cfi_cmdset_0002); 17571da177e4SLinus Torvalds return 0; 17581da177e4SLinus Torvalds } 17591da177e4SLinus Torvalds 17601da177e4SLinus Torvalds 17611da177e4SLinus Torvalds static void __exit cfi_amdstd_exit(void) 17621da177e4SLinus Torvalds { 17631da177e4SLinus Torvalds inter_module_unregister(im_name); 17641da177e4SLinus Torvalds } 17651da177e4SLinus Torvalds 17661da177e4SLinus Torvalds 17671da177e4SLinus Torvalds module_init(cfi_amdstd_init); 17681da177e4SLinus Torvalds module_exit(cfi_amdstd_exit); 17691da177e4SLinus Torvalds 17701da177e4SLinus Torvalds MODULE_LICENSE("GPL"); 17711da177e4SLinus Torvalds MODULE_AUTHOR("Crossnet Co. <info@crossnet.co.jp> et al."); 17721da177e4SLinus Torvalds MODULE_DESCRIPTION("MTD chip driver for AMD/Fujitsu flash chips"); 1773