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 * 1687e92c06SChristopher Moore * 25/09/2008 Christopher Moore: TopBottom fixup for many Macronix with CFI V1.0 1787e92c06SChristopher Moore * 181da177e4SLinus Torvalds * Occasionally maintained by Thayne Harbaugh tharbaugh at lnxi dot com 191da177e4SLinus Torvalds * 201da177e4SLinus Torvalds * This code is GPL 211da177e4SLinus Torvalds */ 221da177e4SLinus Torvalds 231da177e4SLinus Torvalds #include <linux/module.h> 241da177e4SLinus Torvalds #include <linux/types.h> 251da177e4SLinus Torvalds #include <linux/kernel.h> 261da177e4SLinus Torvalds #include <linux/sched.h> 271da177e4SLinus Torvalds #include <linux/init.h> 281da177e4SLinus Torvalds #include <asm/io.h> 291da177e4SLinus Torvalds #include <asm/byteorder.h> 301da177e4SLinus Torvalds 311da177e4SLinus Torvalds #include <linux/errno.h> 321da177e4SLinus Torvalds #include <linux/slab.h> 331da177e4SLinus Torvalds #include <linux/delay.h> 341da177e4SLinus Torvalds #include <linux/interrupt.h> 35eafe1311SKevin Cernekee #include <linux/reboot.h> 361648eaaaSStefan Roese #include <linux/of.h> 371648eaaaSStefan Roese #include <linux/of_platform.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 SST49LF004B 0x0060 4989072ef9SRyan Jackson #define SST49LF040B 0x0050 50fb4a90bfSEric W. Biedermann #define SST49LF008A 0x005a 510165508cSHaavard Skinnemoen #define AT49BV6416 0x00d6 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 *); 61eafe1311SKevin Cernekee static int cfi_amdstd_reboot(struct notifier_block *, unsigned long, void *); 621da177e4SLinus Torvalds static int cfi_amdstd_secsi_read (struct mtd_info *, loff_t, size_t, size_t *, u_char *); 631da177e4SLinus Torvalds 6430ec5a2cSIra W. Snyder static int cfi_amdstd_panic_write(struct mtd_info *mtd, loff_t to, size_t len, 6530ec5a2cSIra W. Snyder size_t *retlen, const u_char *buf); 6630ec5a2cSIra W. Snyder 671da177e4SLinus Torvalds static void cfi_amdstd_destroy(struct mtd_info *); 681da177e4SLinus Torvalds 691da177e4SLinus Torvalds struct mtd_info *cfi_cmdset_0002(struct map_info *, int); 701da177e4SLinus Torvalds static struct mtd_info *cfi_amdstd_setup (struct mtd_info *); 711da177e4SLinus Torvalds 721da177e4SLinus Torvalds static int get_chip(struct map_info *map, struct flchip *chip, unsigned long adr, int mode); 731da177e4SLinus Torvalds static void put_chip(struct map_info *map, struct flchip *chip, unsigned long adr); 741da177e4SLinus Torvalds #include "fwh_lock.h" 751da177e4SLinus Torvalds 7669423d99SAdrian Hunter static int cfi_atmel_lock(struct mtd_info *mtd, loff_t ofs, uint64_t len); 7769423d99SAdrian Hunter static int cfi_atmel_unlock(struct mtd_info *mtd, loff_t ofs, uint64_t len); 780165508cSHaavard Skinnemoen 791648eaaaSStefan Roese static int cfi_ppb_lock(struct mtd_info *mtd, loff_t ofs, uint64_t len); 801648eaaaSStefan Roese static int cfi_ppb_unlock(struct mtd_info *mtd, loff_t ofs, uint64_t len); 811648eaaaSStefan Roese static int cfi_ppb_is_locked(struct mtd_info *mtd, loff_t ofs, uint64_t len); 821648eaaaSStefan Roese 831da177e4SLinus Torvalds static struct mtd_chip_driver cfi_amdstd_chipdrv = { 841da177e4SLinus Torvalds .probe = NULL, /* Not usable directly */ 851da177e4SLinus Torvalds .destroy = cfi_amdstd_destroy, 861da177e4SLinus Torvalds .name = "cfi_cmdset_0002", 871da177e4SLinus Torvalds .module = THIS_MODULE 881da177e4SLinus Torvalds }; 891da177e4SLinus Torvalds 901da177e4SLinus Torvalds 911da177e4SLinus Torvalds /* #define DEBUG_CFI_FEATURES */ 921da177e4SLinus Torvalds 931da177e4SLinus Torvalds 941da177e4SLinus Torvalds #ifdef DEBUG_CFI_FEATURES 951da177e4SLinus Torvalds static void cfi_tell_features(struct cfi_pri_amdstd *extp) 961da177e4SLinus Torvalds { 971da177e4SLinus Torvalds const char* erase_suspend[3] = { 981da177e4SLinus Torvalds "Not supported", "Read only", "Read/write" 991da177e4SLinus Torvalds }; 1001da177e4SLinus Torvalds const char* top_bottom[6] = { 1011da177e4SLinus Torvalds "No WP", "8x8KiB sectors at top & bottom, no WP", 1021da177e4SLinus Torvalds "Bottom boot", "Top boot", 1031da177e4SLinus Torvalds "Uniform, Bottom WP", "Uniform, Top WP" 1041da177e4SLinus Torvalds }; 1051da177e4SLinus Torvalds 1061da177e4SLinus Torvalds printk(" Silicon revision: %d\n", extp->SiliconRevision >> 1); 1071da177e4SLinus Torvalds printk(" Address sensitive unlock: %s\n", 1081da177e4SLinus Torvalds (extp->SiliconRevision & 1) ? "Not required" : "Required"); 1091da177e4SLinus Torvalds 1101da177e4SLinus Torvalds if (extp->EraseSuspend < ARRAY_SIZE(erase_suspend)) 1111da177e4SLinus Torvalds printk(" Erase Suspend: %s\n", erase_suspend[extp->EraseSuspend]); 1121da177e4SLinus Torvalds else 1131da177e4SLinus Torvalds printk(" Erase Suspend: Unknown value %d\n", extp->EraseSuspend); 1141da177e4SLinus Torvalds 1151da177e4SLinus Torvalds if (extp->BlkProt == 0) 1161da177e4SLinus Torvalds printk(" Block protection: Not supported\n"); 1171da177e4SLinus Torvalds else 1181da177e4SLinus Torvalds printk(" Block protection: %d sectors per group\n", extp->BlkProt); 1191da177e4SLinus Torvalds 1201da177e4SLinus Torvalds 1211da177e4SLinus Torvalds printk(" Temporary block unprotect: %s\n", 1221da177e4SLinus Torvalds extp->TmpBlkUnprotect ? "Supported" : "Not supported"); 1231da177e4SLinus Torvalds printk(" Block protect/unprotect scheme: %d\n", extp->BlkProtUnprot); 1241da177e4SLinus Torvalds printk(" Number of simultaneous operations: %d\n", extp->SimultaneousOps); 1251da177e4SLinus Torvalds printk(" Burst mode: %s\n", 1261da177e4SLinus Torvalds extp->BurstMode ? "Supported" : "Not supported"); 1271da177e4SLinus Torvalds if (extp->PageMode == 0) 1281da177e4SLinus Torvalds printk(" Page mode: Not supported\n"); 1291da177e4SLinus Torvalds else 1301da177e4SLinus Torvalds printk(" Page mode: %d word page\n", extp->PageMode << 2); 1311da177e4SLinus Torvalds 1321da177e4SLinus Torvalds printk(" Vpp Supply Minimum Program/Erase Voltage: %d.%d V\n", 1331da177e4SLinus Torvalds extp->VppMin >> 4, extp->VppMin & 0xf); 1341da177e4SLinus Torvalds printk(" Vpp Supply Maximum Program/Erase Voltage: %d.%d V\n", 1351da177e4SLinus Torvalds extp->VppMax >> 4, extp->VppMax & 0xf); 1361da177e4SLinus Torvalds 1371da177e4SLinus Torvalds if (extp->TopBottom < ARRAY_SIZE(top_bottom)) 1381da177e4SLinus Torvalds printk(" Top/Bottom Boot Block: %s\n", top_bottom[extp->TopBottom]); 1391da177e4SLinus Torvalds else 1401da177e4SLinus Torvalds printk(" Top/Bottom Boot Block: Unknown value %d\n", extp->TopBottom); 1411da177e4SLinus Torvalds } 1421da177e4SLinus Torvalds #endif 1431da177e4SLinus Torvalds 1441da177e4SLinus Torvalds #ifdef AMD_BOOTLOC_BUG 1451da177e4SLinus Torvalds /* Wheee. Bring me the head of someone at AMD. */ 146cc318222SGuillaume LECERF static void fixup_amd_bootblock(struct mtd_info *mtd) 1471da177e4SLinus Torvalds { 1481da177e4SLinus Torvalds struct map_info *map = mtd->priv; 1491da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 1501da177e4SLinus Torvalds struct cfi_pri_amdstd *extp = cfi->cmdset_priv; 1511da177e4SLinus Torvalds __u8 major = extp->MajorVersion; 1521da177e4SLinus Torvalds __u8 minor = extp->MinorVersion; 1531da177e4SLinus Torvalds 1541da177e4SLinus Torvalds if (((major << 8) | minor) < 0x3131) { 1551da177e4SLinus Torvalds /* CFI version 1.0 => don't trust bootloc */ 15687e92c06SChristopher Moore 157289c0522SBrian Norris pr_debug("%s: JEDEC Vendor ID is 0x%02X Device ID is 0x%02X\n", 15887e92c06SChristopher Moore map->name, cfi->mfr, cfi->id); 15987e92c06SChristopher Moore 16087e92c06SChristopher Moore /* AFAICS all 29LV400 with a bottom boot block have a device ID 16187e92c06SChristopher Moore * of 0x22BA in 16-bit mode and 0xBA in 8-bit mode. 16287e92c06SChristopher Moore * These were badly detected as they have the 0x80 bit set 16387e92c06SChristopher Moore * so treat them as a special case. 16487e92c06SChristopher Moore */ 16587e92c06SChristopher Moore if (((cfi->id == 0xBA) || (cfi->id == 0x22BA)) && 16687e92c06SChristopher Moore 16787e92c06SChristopher Moore /* Macronix added CFI to their 2nd generation 16887e92c06SChristopher Moore * MX29LV400C B/T but AFAICS no other 29LV400 (AMD, 16987e92c06SChristopher Moore * Fujitsu, Spansion, EON, ESI and older Macronix) 17087e92c06SChristopher Moore * has CFI. 17187e92c06SChristopher Moore * 17287e92c06SChristopher Moore * Therefore also check the manufacturer. 17387e92c06SChristopher Moore * This reduces the risk of false detection due to 17487e92c06SChristopher Moore * the 8-bit device ID. 17587e92c06SChristopher Moore */ 176f3e69c65SGuillaume LECERF (cfi->mfr == CFI_MFR_MACRONIX)) { 177289c0522SBrian Norris pr_debug("%s: Macronix MX29LV400C with bottom boot block" 17887e92c06SChristopher Moore " detected\n", map->name); 17987e92c06SChristopher Moore extp->TopBottom = 2; /* bottom boot */ 18087e92c06SChristopher Moore } else 1811da177e4SLinus Torvalds if (cfi->id & 0x80) { 1821da177e4SLinus Torvalds printk(KERN_WARNING "%s: JEDEC Device ID is 0x%02X. Assuming broken CFI table.\n", map->name, cfi->id); 1831da177e4SLinus Torvalds extp->TopBottom = 3; /* top boot */ 1841da177e4SLinus Torvalds } else { 1851da177e4SLinus Torvalds extp->TopBottom = 2; /* bottom boot */ 1861da177e4SLinus Torvalds } 18787e92c06SChristopher Moore 188289c0522SBrian Norris pr_debug("%s: AMD CFI PRI V%c.%c has no boot block field;" 18987e92c06SChristopher Moore " deduced %s from Device ID\n", map->name, major, minor, 19087e92c06SChristopher Moore extp->TopBottom == 2 ? "bottom" : "top"); 1911da177e4SLinus Torvalds } 1921da177e4SLinus Torvalds } 1931da177e4SLinus Torvalds #endif 1941da177e4SLinus Torvalds 195cc318222SGuillaume LECERF static void fixup_use_write_buffers(struct mtd_info *mtd) 1961da177e4SLinus Torvalds { 1971da177e4SLinus Torvalds struct map_info *map = mtd->priv; 1981da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 1991da177e4SLinus Torvalds if (cfi->cfiq->BufWriteTimeoutTyp) { 200289c0522SBrian Norris pr_debug("Using buffer write method\n" ); 2013c3c10bbSArtem Bityutskiy mtd->_write = cfi_amdstd_write_buffers; 2021da177e4SLinus Torvalds } 2031da177e4SLinus Torvalds } 2041da177e4SLinus Torvalds 2055b0c5c2cSHaavard Skinnemoen /* Atmel chips don't use the same PRI format as AMD chips */ 206cc318222SGuillaume LECERF static void fixup_convert_atmel_pri(struct mtd_info *mtd) 2075b0c5c2cSHaavard Skinnemoen { 2085b0c5c2cSHaavard Skinnemoen struct map_info *map = mtd->priv; 2095b0c5c2cSHaavard Skinnemoen struct cfi_private *cfi = map->fldrv_priv; 2105b0c5c2cSHaavard Skinnemoen struct cfi_pri_amdstd *extp = cfi->cmdset_priv; 2115b0c5c2cSHaavard Skinnemoen struct cfi_pri_atmel atmel_pri; 2125b0c5c2cSHaavard Skinnemoen 2135b0c5c2cSHaavard Skinnemoen memcpy(&atmel_pri, extp, sizeof(atmel_pri)); 214de591dacSHåvard Skinnemoen memset((char *)extp + 5, 0, sizeof(*extp) - 5); 2155b0c5c2cSHaavard Skinnemoen 2165b0c5c2cSHaavard Skinnemoen if (atmel_pri.Features & 0x02) 2175b0c5c2cSHaavard Skinnemoen extp->EraseSuspend = 2; 2185b0c5c2cSHaavard Skinnemoen 219be8f78b8SHaavard Skinnemoen /* Some chips got it backwards... */ 220be8f78b8SHaavard Skinnemoen if (cfi->id == AT49BV6416) { 221be8f78b8SHaavard Skinnemoen if (atmel_pri.BottomBoot) 222be8f78b8SHaavard Skinnemoen extp->TopBottom = 3; 223be8f78b8SHaavard Skinnemoen else 224be8f78b8SHaavard Skinnemoen extp->TopBottom = 2; 225be8f78b8SHaavard Skinnemoen } else { 2265b0c5c2cSHaavard Skinnemoen if (atmel_pri.BottomBoot) 2275b0c5c2cSHaavard Skinnemoen extp->TopBottom = 2; 2285b0c5c2cSHaavard Skinnemoen else 2295b0c5c2cSHaavard Skinnemoen extp->TopBottom = 3; 230be8f78b8SHaavard Skinnemoen } 231d10a39d1SHans-Christian Egtvedt 232d10a39d1SHans-Christian Egtvedt /* burst write mode not supported */ 233d10a39d1SHans-Christian Egtvedt cfi->cfiq->BufWriteTimeoutTyp = 0; 234d10a39d1SHans-Christian Egtvedt cfi->cfiq->BufWriteTimeoutMax = 0; 2355b0c5c2cSHaavard Skinnemoen } 2365b0c5c2cSHaavard Skinnemoen 237cc318222SGuillaume LECERF static void fixup_use_secsi(struct mtd_info *mtd) 2381da177e4SLinus Torvalds { 2391da177e4SLinus Torvalds /* Setup for chips with a secsi area */ 2403c3c10bbSArtem Bityutskiy mtd->_read_user_prot_reg = cfi_amdstd_secsi_read; 2413c3c10bbSArtem Bityutskiy mtd->_read_fact_prot_reg = cfi_amdstd_secsi_read; 2421da177e4SLinus Torvalds } 2431da177e4SLinus Torvalds 244cc318222SGuillaume LECERF static void fixup_use_erase_chip(struct mtd_info *mtd) 2451da177e4SLinus Torvalds { 2461da177e4SLinus Torvalds struct map_info *map = mtd->priv; 2471da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 2481da177e4SLinus Torvalds if ((cfi->cfiq->NumEraseRegions == 1) && 2491da177e4SLinus Torvalds ((cfi->cfiq->EraseRegionInfo[0] & 0xffff) == 0)) { 2503c3c10bbSArtem Bityutskiy mtd->_erase = cfi_amdstd_erase_chip; 2511da177e4SLinus Torvalds } 2521da177e4SLinus Torvalds 2531da177e4SLinus Torvalds } 2541da177e4SLinus Torvalds 2550165508cSHaavard Skinnemoen /* 2560165508cSHaavard Skinnemoen * Some Atmel chips (e.g. the AT49BV6416) power-up with all sectors 2570165508cSHaavard Skinnemoen * locked by default. 2580165508cSHaavard Skinnemoen */ 259cc318222SGuillaume LECERF static void fixup_use_atmel_lock(struct mtd_info *mtd) 2600165508cSHaavard Skinnemoen { 2613c3c10bbSArtem Bityutskiy mtd->_lock = cfi_atmel_lock; 2623c3c10bbSArtem Bityutskiy mtd->_unlock = cfi_atmel_unlock; 263e619a75fSJustin Treon mtd->flags |= MTD_POWERUP_LOCK; 2640165508cSHaavard Skinnemoen } 2650165508cSHaavard Skinnemoen 26683dcd3bbSGuillaume LECERF static void fixup_old_sst_eraseregion(struct mtd_info *mtd) 26783dcd3bbSGuillaume LECERF { 26883dcd3bbSGuillaume LECERF struct map_info *map = mtd->priv; 26983dcd3bbSGuillaume LECERF struct cfi_private *cfi = map->fldrv_priv; 27083dcd3bbSGuillaume LECERF 27183dcd3bbSGuillaume LECERF /* 27225985edcSLucas De Marchi * These flashes report two separate eraseblock regions based on the 27383dcd3bbSGuillaume LECERF * sector_erase-size and block_erase-size, although they both operate on the 27483dcd3bbSGuillaume LECERF * same memory. This is not allowed according to CFI, so we just pick the 27583dcd3bbSGuillaume LECERF * sector_erase-size. 27683dcd3bbSGuillaume LECERF */ 27783dcd3bbSGuillaume LECERF cfi->cfiq->NumEraseRegions = 1; 27883dcd3bbSGuillaume LECERF } 27983dcd3bbSGuillaume LECERF 280cc318222SGuillaume LECERF static void fixup_sst39vf(struct mtd_info *mtd) 28183dcd3bbSGuillaume LECERF { 28283dcd3bbSGuillaume LECERF struct map_info *map = mtd->priv; 28383dcd3bbSGuillaume LECERF struct cfi_private *cfi = map->fldrv_priv; 28483dcd3bbSGuillaume LECERF 28583dcd3bbSGuillaume LECERF fixup_old_sst_eraseregion(mtd); 28683dcd3bbSGuillaume LECERF 28783dcd3bbSGuillaume LECERF cfi->addr_unlock1 = 0x5555; 28883dcd3bbSGuillaume LECERF cfi->addr_unlock2 = 0x2AAA; 28983dcd3bbSGuillaume LECERF } 29083dcd3bbSGuillaume LECERF 291cc318222SGuillaume LECERF static void fixup_sst39vf_rev_b(struct mtd_info *mtd) 2925a0563f0SGuillaume LECERF { 2935a0563f0SGuillaume LECERF struct map_info *map = mtd->priv; 2945a0563f0SGuillaume LECERF struct cfi_private *cfi = map->fldrv_priv; 2955a0563f0SGuillaume LECERF 2965a0563f0SGuillaume LECERF fixup_old_sst_eraseregion(mtd); 2975a0563f0SGuillaume LECERF 2985a0563f0SGuillaume LECERF cfi->addr_unlock1 = 0x555; 2995a0563f0SGuillaume LECERF cfi->addr_unlock2 = 0x2AA; 30008968041SGuillaume LECERF 30108968041SGuillaume LECERF cfi->sector_erase_cmd = CMD(0x50); 3025a0563f0SGuillaume LECERF } 3035a0563f0SGuillaume LECERF 304cc318222SGuillaume LECERF static void fixup_sst38vf640x_sectorsize(struct mtd_info *mtd) 3059fc05fcaSGuillaume LECERF { 3069fc05fcaSGuillaume LECERF struct map_info *map = mtd->priv; 3079fc05fcaSGuillaume LECERF struct cfi_private *cfi = map->fldrv_priv; 3089fc05fcaSGuillaume LECERF 309cc318222SGuillaume LECERF fixup_sst39vf_rev_b(mtd); 3109fc05fcaSGuillaume LECERF 3119fc05fcaSGuillaume LECERF /* 3129fc05fcaSGuillaume LECERF * CFI reports 1024 sectors (0x03ff+1) of 64KBytes (0x0100*256) where 3139fc05fcaSGuillaume LECERF * it should report a size of 8KBytes (0x0020*256). 3149fc05fcaSGuillaume LECERF */ 3159fc05fcaSGuillaume LECERF cfi->cfiq->EraseRegionInfo[0] = 0x002003ff; 3169fc05fcaSGuillaume LECERF pr_warning("%s: Bad 38VF640x CFI data; adjusting sector size from 64 to 8KiB\n", mtd->name); 3179fc05fcaSGuillaume LECERF } 3189fc05fcaSGuillaume LECERF 319cc318222SGuillaume LECERF static void fixup_s29gl064n_sectors(struct mtd_info *mtd) 32070b07255STrent Piepho { 32170b07255STrent Piepho struct map_info *map = mtd->priv; 32270b07255STrent Piepho struct cfi_private *cfi = map->fldrv_priv; 32370b07255STrent Piepho 32470b07255STrent Piepho if ((cfi->cfiq->EraseRegionInfo[0] & 0xffff) == 0x003f) { 32570b07255STrent Piepho cfi->cfiq->EraseRegionInfo[0] |= 0x0040; 3265df41de5SDavid Woodhouse pr_warning("%s: Bad S29GL064N CFI data; adjust from 64 to 128 sectors\n", mtd->name); 32770b07255STrent Piepho } 32870b07255STrent Piepho } 32970b07255STrent Piepho 330cc318222SGuillaume LECERF static void fixup_s29gl032n_sectors(struct mtd_info *mtd) 33170b07255STrent Piepho { 33270b07255STrent Piepho struct map_info *map = mtd->priv; 33370b07255STrent Piepho struct cfi_private *cfi = map->fldrv_priv; 33470b07255STrent Piepho 33570b07255STrent Piepho if ((cfi->cfiq->EraseRegionInfo[1] & 0xffff) == 0x007e) { 33670b07255STrent Piepho cfi->cfiq->EraseRegionInfo[1] &= ~0x0040; 3375df41de5SDavid Woodhouse pr_warning("%s: Bad S29GL032N CFI data; adjust from 127 to 63 sectors\n", mtd->name); 33870b07255STrent Piepho } 33970b07255STrent Piepho } 34070b07255STrent Piepho 34143dc03c7SJavier Martin static void fixup_s29ns512p_sectors(struct mtd_info *mtd) 34243dc03c7SJavier Martin { 34343dc03c7SJavier Martin struct map_info *map = mtd->priv; 34443dc03c7SJavier Martin struct cfi_private *cfi = map->fldrv_priv; 34543dc03c7SJavier Martin 34643dc03c7SJavier Martin /* 34743dc03c7SJavier Martin * S29NS512P flash uses more than 8bits to report number of sectors, 34843dc03c7SJavier Martin * which is not permitted by CFI. 34943dc03c7SJavier Martin */ 35043dc03c7SJavier Martin cfi->cfiq->EraseRegionInfo[0] = 0x020001ff; 3515df41de5SDavid Woodhouse pr_warning("%s: Bad S29NS512P CFI data; adjust to 512 sectors\n", mtd->name); 35243dc03c7SJavier Martin } 35343dc03c7SJavier Martin 35483dcd3bbSGuillaume LECERF /* Used to fix CFI-Tables of chips without Extended Query Tables */ 35583dcd3bbSGuillaume LECERF static struct cfi_fixup cfi_nopri_fixup_table[] = { 356cc318222SGuillaume LECERF { CFI_MFR_SST, 0x234a, fixup_sst39vf }, /* SST39VF1602 */ 357cc318222SGuillaume LECERF { CFI_MFR_SST, 0x234b, fixup_sst39vf }, /* SST39VF1601 */ 358cc318222SGuillaume LECERF { CFI_MFR_SST, 0x235a, fixup_sst39vf }, /* SST39VF3202 */ 359cc318222SGuillaume LECERF { CFI_MFR_SST, 0x235b, fixup_sst39vf }, /* SST39VF3201 */ 360cc318222SGuillaume LECERF { CFI_MFR_SST, 0x235c, fixup_sst39vf_rev_b }, /* SST39VF3202B */ 361cc318222SGuillaume LECERF { CFI_MFR_SST, 0x235d, fixup_sst39vf_rev_b }, /* SST39VF3201B */ 362cc318222SGuillaume LECERF { CFI_MFR_SST, 0x236c, fixup_sst39vf_rev_b }, /* SST39VF6402B */ 363cc318222SGuillaume LECERF { CFI_MFR_SST, 0x236d, fixup_sst39vf_rev_b }, /* SST39VF6401B */ 364cc318222SGuillaume LECERF { 0, 0, NULL } 36583dcd3bbSGuillaume LECERF }; 36683dcd3bbSGuillaume LECERF 3671da177e4SLinus Torvalds static struct cfi_fixup cfi_fixup_table[] = { 368cc318222SGuillaume LECERF { CFI_MFR_ATMEL, CFI_ID_ANY, fixup_convert_atmel_pri }, 3691da177e4SLinus Torvalds #ifdef AMD_BOOTLOC_BUG 370cc318222SGuillaume LECERF { CFI_MFR_AMD, CFI_ID_ANY, fixup_amd_bootblock }, 3711065cda8SSteffen Sledz { CFI_MFR_AMIC, CFI_ID_ANY, fixup_amd_bootblock }, 372cc318222SGuillaume LECERF { CFI_MFR_MACRONIX, CFI_ID_ANY, fixup_amd_bootblock }, 3731da177e4SLinus Torvalds #endif 374cc318222SGuillaume LECERF { CFI_MFR_AMD, 0x0050, fixup_use_secsi }, 375cc318222SGuillaume LECERF { CFI_MFR_AMD, 0x0053, fixup_use_secsi }, 376cc318222SGuillaume LECERF { CFI_MFR_AMD, 0x0055, fixup_use_secsi }, 377cc318222SGuillaume LECERF { CFI_MFR_AMD, 0x0056, fixup_use_secsi }, 378cc318222SGuillaume LECERF { CFI_MFR_AMD, 0x005C, fixup_use_secsi }, 379cc318222SGuillaume LECERF { CFI_MFR_AMD, 0x005F, fixup_use_secsi }, 380cc318222SGuillaume LECERF { CFI_MFR_AMD, 0x0c01, fixup_s29gl064n_sectors }, 381cc318222SGuillaume LECERF { CFI_MFR_AMD, 0x1301, fixup_s29gl064n_sectors }, 382cc318222SGuillaume LECERF { CFI_MFR_AMD, 0x1a00, fixup_s29gl032n_sectors }, 383cc318222SGuillaume LECERF { CFI_MFR_AMD, 0x1a01, fixup_s29gl032n_sectors }, 38443dc03c7SJavier Martin { CFI_MFR_AMD, 0x3f00, fixup_s29ns512p_sectors }, 385cc318222SGuillaume LECERF { CFI_MFR_SST, 0x536a, fixup_sst38vf640x_sectorsize }, /* SST38VF6402 */ 386cc318222SGuillaume LECERF { CFI_MFR_SST, 0x536b, fixup_sst38vf640x_sectorsize }, /* SST38VF6401 */ 387cc318222SGuillaume LECERF { CFI_MFR_SST, 0x536c, fixup_sst38vf640x_sectorsize }, /* SST38VF6404 */ 388cc318222SGuillaume LECERF { CFI_MFR_SST, 0x536d, fixup_sst38vf640x_sectorsize }, /* SST38VF6403 */ 3891da177e4SLinus Torvalds #if !FORCE_WORD_WRITE 390cc318222SGuillaume LECERF { CFI_MFR_ANY, CFI_ID_ANY, fixup_use_write_buffers }, 3911da177e4SLinus Torvalds #endif 392cc318222SGuillaume LECERF { 0, 0, NULL } 3931da177e4SLinus Torvalds }; 3941da177e4SLinus Torvalds static struct cfi_fixup jedec_fixup_table[] = { 395cc318222SGuillaume LECERF { CFI_MFR_SST, SST49LF004B, fixup_use_fwh_lock }, 396cc318222SGuillaume LECERF { CFI_MFR_SST, SST49LF040B, fixup_use_fwh_lock }, 397cc318222SGuillaume LECERF { CFI_MFR_SST, SST49LF008A, fixup_use_fwh_lock }, 398cc318222SGuillaume LECERF { 0, 0, NULL } 3991da177e4SLinus Torvalds }; 4001da177e4SLinus Torvalds 4011da177e4SLinus Torvalds static struct cfi_fixup fixup_table[] = { 4021da177e4SLinus Torvalds /* The CFI vendor ids and the JEDEC vendor IDs appear 4031da177e4SLinus Torvalds * to be common. It is like the devices id's are as 4041da177e4SLinus Torvalds * well. This table is to pick all cases where 4051da177e4SLinus Torvalds * we know that is the case. 4061da177e4SLinus Torvalds */ 407cc318222SGuillaume LECERF { CFI_MFR_ANY, CFI_ID_ANY, fixup_use_erase_chip }, 408cc318222SGuillaume LECERF { CFI_MFR_ATMEL, AT49BV6416, fixup_use_atmel_lock }, 409cc318222SGuillaume LECERF { 0, 0, NULL } 4101da177e4SLinus Torvalds }; 4111da177e4SLinus Torvalds 4121da177e4SLinus Torvalds 413fefae48bSWolfgang Grandegger static void cfi_fixup_major_minor(struct cfi_private *cfi, 414fefae48bSWolfgang Grandegger struct cfi_pri_amdstd *extp) 415fefae48bSWolfgang Grandegger { 416e6372763SGuillaume LECERF if (cfi->mfr == CFI_MFR_SAMSUNG) { 417e8953b73SGuillaume LECERF if ((extp->MajorVersion == '0' && extp->MinorVersion == '0') || 418e8953b73SGuillaume LECERF (extp->MajorVersion == '3' && extp->MinorVersion == '3')) { 419e6372763SGuillaume LECERF /* 420e6372763SGuillaume LECERF * Samsung K8P2815UQB and K8D6x16UxM chips 421e6372763SGuillaume LECERF * report major=0 / minor=0. 422e8953b73SGuillaume LECERF * K8D3x16UxC chips report major=3 / minor=3. 423e6372763SGuillaume LECERF */ 424e6372763SGuillaume LECERF printk(KERN_NOTICE " Fixing Samsung's Amd/Fujitsu" 425e6372763SGuillaume LECERF " Extended Query version to 1.%c\n", 426e6372763SGuillaume LECERF extp->MinorVersion); 427fefae48bSWolfgang Grandegger extp->MajorVersion = '1'; 428e6372763SGuillaume LECERF } 429e6372763SGuillaume LECERF } 430e6372763SGuillaume LECERF 4319fc05fcaSGuillaume LECERF /* 4329fc05fcaSGuillaume LECERF * SST 38VF640x chips report major=0xFF / minor=0xFF. 4339fc05fcaSGuillaume LECERF */ 4349fc05fcaSGuillaume LECERF if (cfi->mfr == CFI_MFR_SST && (cfi->id >> 4) == 0x0536) { 4359fc05fcaSGuillaume LECERF extp->MajorVersion = '1'; 4369fc05fcaSGuillaume LECERF extp->MinorVersion = '0'; 4379fc05fcaSGuillaume LECERF } 438fefae48bSWolfgang Grandegger } 439fefae48bSWolfgang Grandegger 44042096288SGerlando Falauto static int is_m29ew(struct cfi_private *cfi) 44142096288SGerlando Falauto { 44242096288SGerlando Falauto if (cfi->mfr == CFI_MFR_INTEL && 44342096288SGerlando Falauto ((cfi->device_type == CFI_DEVICETYPE_X8 && (cfi->id & 0xff) == 0x7e) || 44442096288SGerlando Falauto (cfi->device_type == CFI_DEVICETYPE_X16 && cfi->id == 0x227e))) 44542096288SGerlando Falauto return 1; 44642096288SGerlando Falauto return 0; 44742096288SGerlando Falauto } 44842096288SGerlando Falauto 44942096288SGerlando Falauto /* 45042096288SGerlando Falauto * From TN-13-07: Patching the Linux Kernel and U-Boot for M29 Flash, page 20: 45142096288SGerlando Falauto * Some revisions of the M29EW suffer from erase suspend hang ups. In 45242096288SGerlando Falauto * particular, it can occur when the sequence 45342096288SGerlando Falauto * Erase Confirm -> Suspend -> Program -> Resume 45442096288SGerlando Falauto * causes a lockup due to internal timing issues. The consequence is that the 45542096288SGerlando Falauto * erase cannot be resumed without inserting a dummy command after programming 45642096288SGerlando Falauto * and prior to resuming. [...] The work-around is to issue a dummy write cycle 45742096288SGerlando Falauto * that writes an F0 command code before the RESUME command. 45842096288SGerlando Falauto */ 45942096288SGerlando Falauto static void cfi_fixup_m29ew_erase_suspend(struct map_info *map, 46042096288SGerlando Falauto unsigned long adr) 46142096288SGerlando Falauto { 46242096288SGerlando Falauto struct cfi_private *cfi = map->fldrv_priv; 46342096288SGerlando Falauto /* before resume, insert a dummy 0xF0 cycle for Micron M29EW devices */ 46442096288SGerlando Falauto if (is_m29ew(cfi)) 46542096288SGerlando Falauto map_write(map, CMD(0xF0), adr); 46642096288SGerlando Falauto } 46742096288SGerlando Falauto 46842096288SGerlando Falauto /* 46942096288SGerlando Falauto * From TN-13-07: Patching the Linux Kernel and U-Boot for M29 Flash, page 22: 47042096288SGerlando Falauto * 47142096288SGerlando Falauto * Some revisions of the M29EW (for example, A1 and A2 step revisions) 47242096288SGerlando Falauto * are affected by a problem that could cause a hang up when an ERASE SUSPEND 47342096288SGerlando Falauto * command is issued after an ERASE RESUME operation without waiting for a 47442096288SGerlando Falauto * minimum delay. The result is that once the ERASE seems to be completed 47542096288SGerlando Falauto * (no bits are toggling), the contents of the Flash memory block on which 47642096288SGerlando Falauto * the erase was ongoing could be inconsistent with the expected values 47742096288SGerlando Falauto * (typically, the array value is stuck to the 0xC0, 0xC4, 0x80, or 0x84 47842096288SGerlando Falauto * values), causing a consequent failure of the ERASE operation. 47942096288SGerlando Falauto * The occurrence of this issue could be high, especially when file system 48042096288SGerlando Falauto * operations on the Flash are intensive. As a result, it is recommended 48142096288SGerlando Falauto * that a patch be applied. Intensive file system operations can cause many 48242096288SGerlando Falauto * calls to the garbage routine to free Flash space (also by erasing physical 48342096288SGerlando Falauto * Flash blocks) and as a result, many consecutive SUSPEND and RESUME 48442096288SGerlando Falauto * commands can occur. The problem disappears when a delay is inserted after 48542096288SGerlando Falauto * the RESUME command by using the udelay() function available in Linux. 48642096288SGerlando Falauto * The DELAY value must be tuned based on the customer's platform. 48742096288SGerlando Falauto * The maximum value that fixes the problem in all cases is 500us. 48842096288SGerlando Falauto * But, in our experience, a delay of 30 µs to 50 µs is sufficient 48942096288SGerlando Falauto * in most cases. 49042096288SGerlando Falauto * We have chosen 500µs because this latency is acceptable. 49142096288SGerlando Falauto */ 49242096288SGerlando Falauto static void cfi_fixup_m29ew_delay_after_resume(struct cfi_private *cfi) 49342096288SGerlando Falauto { 49442096288SGerlando Falauto /* 49542096288SGerlando Falauto * Resolving the Delay After Resume Issue see Micron TN-13-07 49642096288SGerlando Falauto * Worst case delay must be 500µs but 30-50µs should be ok as well 49742096288SGerlando Falauto */ 49842096288SGerlando Falauto if (is_m29ew(cfi)) 49942096288SGerlando Falauto cfi_udelay(500); 50042096288SGerlando Falauto } 50142096288SGerlando Falauto 5021da177e4SLinus Torvalds struct mtd_info *cfi_cmdset_0002(struct map_info *map, int primary) 5031da177e4SLinus Torvalds { 5041da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 5051648eaaaSStefan Roese struct device_node __maybe_unused *np = map->device_node; 5061da177e4SLinus Torvalds struct mtd_info *mtd; 5071da177e4SLinus Torvalds int i; 5081da177e4SLinus Torvalds 50995b93a0cSBurman Yan mtd = kzalloc(sizeof(*mtd), GFP_KERNEL); 5101da177e4SLinus Torvalds if (!mtd) { 5111da177e4SLinus Torvalds printk(KERN_WARNING "Failed to allocate memory for MTD device\n"); 5121da177e4SLinus Torvalds return NULL; 5131da177e4SLinus Torvalds } 5141da177e4SLinus Torvalds mtd->priv = map; 5151da177e4SLinus Torvalds mtd->type = MTD_NORFLASH; 5161da177e4SLinus Torvalds 5171da177e4SLinus Torvalds /* Fill in the default mtd operations */ 5183c3c10bbSArtem Bityutskiy mtd->_erase = cfi_amdstd_erase_varsize; 5193c3c10bbSArtem Bityutskiy mtd->_write = cfi_amdstd_write_words; 5203c3c10bbSArtem Bityutskiy mtd->_read = cfi_amdstd_read; 5213c3c10bbSArtem Bityutskiy mtd->_sync = cfi_amdstd_sync; 5223c3c10bbSArtem Bityutskiy mtd->_suspend = cfi_amdstd_suspend; 5233c3c10bbSArtem Bityutskiy mtd->_resume = cfi_amdstd_resume; 5241da177e4SLinus Torvalds mtd->flags = MTD_CAP_NORFLASH; 5251da177e4SLinus Torvalds mtd->name = map->name; 526783ed81fSArtem B. Bityutskiy mtd->writesize = 1; 52713ce77f4SAnatolij Gustschin mtd->writebufsize = cfi_interleave(cfi) << cfi->cfiq->MaxBufWriteSize; 528d261c72aSAnatolij Gustschin 5290a32a102SBrian Norris pr_debug("MTD %s(): write buffer size %d\n", __func__, 5300a32a102SBrian Norris mtd->writebufsize); 5311da177e4SLinus Torvalds 5323c3c10bbSArtem Bityutskiy mtd->_panic_write = cfi_amdstd_panic_write; 533eafe1311SKevin Cernekee mtd->reboot_notifier.notifier_call = cfi_amdstd_reboot; 534eafe1311SKevin Cernekee 5351da177e4SLinus Torvalds if (cfi->cfi_mode==CFI_MODE_CFI){ 5361da177e4SLinus Torvalds unsigned char bootloc; 5371da177e4SLinus Torvalds __u16 adr = primary?cfi->cfiq->P_ADR:cfi->cfiq->A_ADR; 5381da177e4SLinus Torvalds struct cfi_pri_amdstd *extp; 5391da177e4SLinus Torvalds 5401da177e4SLinus Torvalds extp = (struct cfi_pri_amdstd*)cfi_read_pri(map, adr, sizeof(*extp), "Amd/Fujitsu"); 541564b8497SGuillaume LECERF if (extp) { 542564b8497SGuillaume LECERF /* 543564b8497SGuillaume LECERF * It's a real CFI chip, not one for which the probe 544564b8497SGuillaume LECERF * routine faked a CFI structure. 545564b8497SGuillaume LECERF */ 546fefae48bSWolfgang Grandegger cfi_fixup_major_minor(cfi, extp); 547fefae48bSWolfgang Grandegger 548e17f47a1SGuillaume LECERF /* 549c9ddab25SGernot Hoyler * Valid primary extension versions are: 1.0, 1.1, 1.2, 1.3, 1.4, 1.5 550631dd1a8SJustin P. Mattock * see: http://cs.ozerki.net/zap/pub/axim-x5/docs/cfi_r20.pdf, page 19 551631dd1a8SJustin P. Mattock * http://www.spansion.com/Support/AppNotes/cfi_100_20011201.pdf 5525da19532SGuillaume LECERF * http://www.spansion.com/Support/Datasheets/s29ws-p_00_a12_e.pdf 553c9ddab25SGernot Hoyler * http://www.spansion.com/Support/Datasheets/S29GL_128S_01GS_00_02_e.pdf 554e17f47a1SGuillaume LECERF */ 555d88f977bSTodd Poynor if (extp->MajorVersion != '1' || 556c9ddab25SGernot Hoyler (extp->MajorVersion == '1' && (extp->MinorVersion < '0' || extp->MinorVersion > '5'))) { 557d88f977bSTodd Poynor printk(KERN_ERR " Unknown Amd/Fujitsu Extended Query " 558e17f47a1SGuillaume LECERF "version %c.%c (%#02x/%#02x).\n", 559e17f47a1SGuillaume LECERF extp->MajorVersion, extp->MinorVersion, 560e17f47a1SGuillaume LECERF extp->MajorVersion, extp->MinorVersion); 561d88f977bSTodd Poynor kfree(extp); 562d88f977bSTodd Poynor kfree(mtd); 563d88f977bSTodd Poynor return NULL; 564d88f977bSTodd Poynor } 565d88f977bSTodd Poynor 566e17f47a1SGuillaume LECERF printk(KERN_INFO " Amd/Fujitsu Extended Query version %c.%c.\n", 567e17f47a1SGuillaume LECERF extp->MajorVersion, extp->MinorVersion); 568e17f47a1SGuillaume LECERF 5691da177e4SLinus Torvalds /* Install our own private info structure */ 5701da177e4SLinus Torvalds cfi->cmdset_priv = extp; 5711da177e4SLinus Torvalds 5721da177e4SLinus Torvalds /* Apply cfi device specific fixups */ 5731da177e4SLinus Torvalds cfi_fixup(mtd, cfi_fixup_table); 5741da177e4SLinus Torvalds 5751da177e4SLinus Torvalds #ifdef DEBUG_CFI_FEATURES 5761da177e4SLinus Torvalds /* Tell the user about it in lots of lovely detail */ 5771da177e4SLinus Torvalds cfi_tell_features(extp); 5781da177e4SLinus Torvalds #endif 5791da177e4SLinus Torvalds 5801648eaaaSStefan Roese #ifdef CONFIG_OF 5811648eaaaSStefan Roese if (np && of_property_read_bool( 5821648eaaaSStefan Roese np, "use-advanced-sector-protection") 5831648eaaaSStefan Roese && extp->BlkProtUnprot == 8) { 5841648eaaaSStefan Roese printk(KERN_INFO " Advanced Sector Protection (PPB Locking) supported\n"); 5851648eaaaSStefan Roese mtd->_lock = cfi_ppb_lock; 5861648eaaaSStefan Roese mtd->_unlock = cfi_ppb_unlock; 5871648eaaaSStefan Roese mtd->_is_locked = cfi_ppb_is_locked; 5881648eaaaSStefan Roese } 5891648eaaaSStefan Roese #endif 5901648eaaaSStefan Roese 5911da177e4SLinus Torvalds bootloc = extp->TopBottom; 592412da2f6SDavid Woodhouse if ((bootloc < 2) || (bootloc > 5)) { 593412da2f6SDavid Woodhouse printk(KERN_WARNING "%s: CFI contains unrecognised boot " 594412da2f6SDavid Woodhouse "bank location (%d). Assuming bottom.\n", 595abab7ebfSDavid Woodhouse map->name, bootloc); 5961da177e4SLinus Torvalds bootloc = 2; 5971da177e4SLinus Torvalds } 5981da177e4SLinus Torvalds 5991da177e4SLinus Torvalds if (bootloc == 3 && cfi->cfiq->NumEraseRegions > 1) { 600412da2f6SDavid Woodhouse printk(KERN_WARNING "%s: Swapping erase regions for top-boot CFI table.\n", map->name); 6011da177e4SLinus Torvalds 6021da177e4SLinus Torvalds for (i=0; i<cfi->cfiq->NumEraseRegions / 2; i++) { 6031da177e4SLinus Torvalds int j = (cfi->cfiq->NumEraseRegions-1)-i; 6041da177e4SLinus Torvalds __u32 swap; 6051da177e4SLinus Torvalds 6061da177e4SLinus Torvalds swap = cfi->cfiq->EraseRegionInfo[i]; 6071da177e4SLinus Torvalds cfi->cfiq->EraseRegionInfo[i] = cfi->cfiq->EraseRegionInfo[j]; 6081da177e4SLinus Torvalds cfi->cfiq->EraseRegionInfo[j] = swap; 6091da177e4SLinus Torvalds } 6101da177e4SLinus Torvalds } 6111da177e4SLinus Torvalds /* Set the default CFI lock/unlock addresses */ 6121da177e4SLinus Torvalds cfi->addr_unlock1 = 0x555; 6131da177e4SLinus Torvalds cfi->addr_unlock2 = 0x2aa; 614564b8497SGuillaume LECERF } 61583dcd3bbSGuillaume LECERF cfi_fixup(mtd, cfi_nopri_fixup_table); 616564b8497SGuillaume LECERF 617564b8497SGuillaume LECERF if (!cfi->addr_unlock1 || !cfi->addr_unlock2) { 618564b8497SGuillaume LECERF kfree(mtd); 619564b8497SGuillaume LECERF return NULL; 620564b8497SGuillaume LECERF } 6211da177e4SLinus Torvalds 6221da177e4SLinus Torvalds } /* CFI mode */ 6231da177e4SLinus Torvalds else if (cfi->cfi_mode == CFI_MODE_JEDEC) { 6241da177e4SLinus Torvalds /* Apply jedec specific fixups */ 6251da177e4SLinus Torvalds cfi_fixup(mtd, jedec_fixup_table); 6261da177e4SLinus Torvalds } 6271da177e4SLinus Torvalds /* Apply generic fixups */ 6281da177e4SLinus Torvalds cfi_fixup(mtd, fixup_table); 6291da177e4SLinus Torvalds 6301da177e4SLinus Torvalds for (i=0; i< cfi->numchips; i++) { 6311da177e4SLinus Torvalds cfi->chips[i].word_write_time = 1<<cfi->cfiq->WordWriteTimeoutTyp; 6321da177e4SLinus Torvalds cfi->chips[i].buffer_write_time = 1<<cfi->cfiq->BufWriteTimeoutTyp; 6331da177e4SLinus Torvalds cfi->chips[i].erase_time = 1<<cfi->cfiq->BlockEraseTimeoutTyp; 63483d48091SVijay Sampath cfi->chips[i].ref_point_counter = 0; 63583d48091SVijay Sampath init_waitqueue_head(&(cfi->chips[i].wq)); 6361da177e4SLinus Torvalds } 6371da177e4SLinus Torvalds 6381da177e4SLinus Torvalds map->fldrv = &cfi_amdstd_chipdrv; 6391da177e4SLinus Torvalds 6401da177e4SLinus Torvalds return cfi_amdstd_setup(mtd); 6411da177e4SLinus Torvalds } 64280461128SGuillaume LECERF struct mtd_info *cfi_cmdset_0006(struct map_info *map, int primary) __attribute__((alias("cfi_cmdset_0002"))); 6431e804cecSDavid Woodhouse struct mtd_info *cfi_cmdset_0701(struct map_info *map, int primary) __attribute__((alias("cfi_cmdset_0002"))); 64483ea4ef2SDavid Woodhouse EXPORT_SYMBOL_GPL(cfi_cmdset_0002); 64580461128SGuillaume LECERF EXPORT_SYMBOL_GPL(cfi_cmdset_0006); 6461e804cecSDavid Woodhouse EXPORT_SYMBOL_GPL(cfi_cmdset_0701); 6471da177e4SLinus Torvalds 6481da177e4SLinus Torvalds static struct mtd_info *cfi_amdstd_setup(struct mtd_info *mtd) 6491da177e4SLinus Torvalds { 6501da177e4SLinus Torvalds struct map_info *map = mtd->priv; 6511da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 6521da177e4SLinus Torvalds unsigned long devsize = (1<<cfi->cfiq->DevSize) * cfi->interleave; 6531da177e4SLinus Torvalds unsigned long offset = 0; 6541da177e4SLinus Torvalds int i,j; 6551da177e4SLinus Torvalds 6561da177e4SLinus Torvalds printk(KERN_NOTICE "number of %s chips: %d\n", 6571da177e4SLinus Torvalds (cfi->cfi_mode == CFI_MODE_CFI)?"CFI":"JEDEC",cfi->numchips); 6581da177e4SLinus Torvalds /* Select the correct geometry setup */ 6591da177e4SLinus Torvalds mtd->size = devsize * cfi->numchips; 6601da177e4SLinus Torvalds 6611da177e4SLinus Torvalds mtd->numeraseregions = cfi->cfiq->NumEraseRegions * cfi->numchips; 6621da177e4SLinus Torvalds mtd->eraseregions = kmalloc(sizeof(struct mtd_erase_region_info) 6631da177e4SLinus Torvalds * mtd->numeraseregions, GFP_KERNEL); 6641da177e4SLinus Torvalds if (!mtd->eraseregions) { 6651da177e4SLinus Torvalds printk(KERN_WARNING "Failed to allocate memory for MTD erase region info\n"); 6661da177e4SLinus Torvalds goto setup_err; 6671da177e4SLinus Torvalds } 6681da177e4SLinus Torvalds 6691da177e4SLinus Torvalds for (i=0; i<cfi->cfiq->NumEraseRegions; i++) { 6701da177e4SLinus Torvalds unsigned long ernum, ersize; 6711da177e4SLinus Torvalds ersize = ((cfi->cfiq->EraseRegionInfo[i] >> 8) & ~0xff) * cfi->interleave; 6721da177e4SLinus Torvalds ernum = (cfi->cfiq->EraseRegionInfo[i] & 0xffff) + 1; 6731da177e4SLinus Torvalds 6741da177e4SLinus Torvalds if (mtd->erasesize < ersize) { 6751da177e4SLinus Torvalds mtd->erasesize = ersize; 6761da177e4SLinus Torvalds } 6771da177e4SLinus Torvalds for (j=0; j<cfi->numchips; j++) { 6781da177e4SLinus Torvalds mtd->eraseregions[(j*cfi->cfiq->NumEraseRegions)+i].offset = (j*devsize)+offset; 6791da177e4SLinus Torvalds mtd->eraseregions[(j*cfi->cfiq->NumEraseRegions)+i].erasesize = ersize; 6801da177e4SLinus Torvalds mtd->eraseregions[(j*cfi->cfiq->NumEraseRegions)+i].numblocks = ernum; 6811da177e4SLinus Torvalds } 6821da177e4SLinus Torvalds offset += (ersize * ernum); 6831da177e4SLinus Torvalds } 6841da177e4SLinus Torvalds if (offset != devsize) { 6851da177e4SLinus Torvalds /* Argh */ 6861da177e4SLinus Torvalds printk(KERN_WARNING "Sum of regions (%lx) != total size of set of interleaved chips (%lx)\n", offset, devsize); 6871da177e4SLinus Torvalds goto setup_err; 6881da177e4SLinus Torvalds } 6891da177e4SLinus Torvalds 6901da177e4SLinus Torvalds __module_get(THIS_MODULE); 691eafe1311SKevin Cernekee register_reboot_notifier(&mtd->reboot_notifier); 6921da177e4SLinus Torvalds return mtd; 6931da177e4SLinus Torvalds 6941da177e4SLinus Torvalds setup_err: 6951da177e4SLinus Torvalds kfree(mtd->eraseregions); 6961da177e4SLinus Torvalds kfree(mtd); 6971da177e4SLinus Torvalds kfree(cfi->cmdset_priv); 6981da177e4SLinus Torvalds kfree(cfi->cfiq); 6991da177e4SLinus Torvalds return NULL; 7001da177e4SLinus Torvalds } 7011da177e4SLinus Torvalds 7021da177e4SLinus Torvalds /* 7031da177e4SLinus Torvalds * Return true if the chip is ready. 7041da177e4SLinus Torvalds * 7051da177e4SLinus Torvalds * Ready is one of: read mode, query mode, erase-suspend-read mode (in any 7061da177e4SLinus Torvalds * non-suspended sector) and is indicated by no toggle bits toggling. 7071da177e4SLinus Torvalds * 7081da177e4SLinus Torvalds * Note that anything more complicated than checking if no bits are toggling 7091da177e4SLinus Torvalds * (including checking DQ5 for an error status) is tricky to get working 71025985edcSLucas De Marchi * correctly and is therefore not done (particularly with interleaved chips 71125985edcSLucas De Marchi * as each chip must be checked independently of the others). 7121da177e4SLinus Torvalds */ 71302b15e34STodd Poynor static int __xipram chip_ready(struct map_info *map, unsigned long addr) 7141da177e4SLinus Torvalds { 7151da177e4SLinus Torvalds map_word d, t; 7161da177e4SLinus Torvalds 7171da177e4SLinus Torvalds d = map_read(map, addr); 7181da177e4SLinus Torvalds t = map_read(map, addr); 7191da177e4SLinus Torvalds 7201da177e4SLinus Torvalds return map_word_equal(map, d, t); 7211da177e4SLinus Torvalds } 7221da177e4SLinus Torvalds 723fb4a90bfSEric W. Biedermann /* 724fb4a90bfSEric W. Biedermann * Return true if the chip is ready and has the correct value. 725fb4a90bfSEric W. Biedermann * 726fb4a90bfSEric W. Biedermann * Ready is one of: read mode, query mode, erase-suspend-read mode (in any 727fb4a90bfSEric W. Biedermann * non-suspended sector) and it is indicated by no bits toggling. 728fb4a90bfSEric W. Biedermann * 729fb4a90bfSEric W. Biedermann * Error are indicated by toggling bits or bits held with the wrong value, 730fb4a90bfSEric W. Biedermann * or with bits toggling. 731fb4a90bfSEric W. Biedermann * 732fb4a90bfSEric W. Biedermann * Note that anything more complicated than checking if no bits are toggling 733fb4a90bfSEric W. Biedermann * (including checking DQ5 for an error status) is tricky to get working 73425985edcSLucas De Marchi * correctly and is therefore not done (particularly with interleaved chips 73525985edcSLucas De Marchi * as each chip must be checked independently of the others). 736fb4a90bfSEric W. Biedermann * 737fb4a90bfSEric W. Biedermann */ 73802b15e34STodd Poynor static int __xipram chip_good(struct map_info *map, unsigned long addr, map_word expected) 739fb4a90bfSEric W. Biedermann { 740fb4a90bfSEric W. Biedermann map_word oldd, curd; 741fb4a90bfSEric W. Biedermann 742fb4a90bfSEric W. Biedermann oldd = map_read(map, addr); 743fb4a90bfSEric W. Biedermann curd = map_read(map, addr); 744fb4a90bfSEric W. Biedermann 745fb4a90bfSEric W. Biedermann return map_word_equal(map, oldd, curd) && 746fb4a90bfSEric W. Biedermann map_word_equal(map, curd, expected); 747fb4a90bfSEric W. Biedermann } 748fb4a90bfSEric W. Biedermann 7491da177e4SLinus Torvalds static int get_chip(struct map_info *map, struct flchip *chip, unsigned long adr, int mode) 7501da177e4SLinus Torvalds { 7511da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 7521da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 7531da177e4SLinus Torvalds unsigned long timeo; 7541da177e4SLinus Torvalds struct cfi_pri_amdstd *cfip = (struct cfi_pri_amdstd *)cfi->cmdset_priv; 7551da177e4SLinus Torvalds 7561da177e4SLinus Torvalds resettime: 7571da177e4SLinus Torvalds timeo = jiffies + HZ; 7581da177e4SLinus Torvalds retry: 7591da177e4SLinus Torvalds switch (chip->state) { 7601da177e4SLinus Torvalds 7611da177e4SLinus Torvalds case FL_STATUS: 7621da177e4SLinus Torvalds for (;;) { 7631da177e4SLinus Torvalds if (chip_ready(map, adr)) 7641da177e4SLinus Torvalds break; 7651da177e4SLinus Torvalds 7661da177e4SLinus Torvalds if (time_after(jiffies, timeo)) { 7671da177e4SLinus Torvalds printk(KERN_ERR "Waiting for chip to be ready timed out.\n"); 7681da177e4SLinus Torvalds return -EIO; 7691da177e4SLinus Torvalds } 770c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 7711da177e4SLinus Torvalds cfi_udelay(1); 772c4e77376SStefani Seibold mutex_lock(&chip->mutex); 7731da177e4SLinus Torvalds /* Someone else might have been playing with it. */ 7741da177e4SLinus Torvalds goto retry; 7751da177e4SLinus Torvalds } 7761da177e4SLinus Torvalds 7771da177e4SLinus Torvalds case FL_READY: 7781da177e4SLinus Torvalds case FL_CFI_QUERY: 7791da177e4SLinus Torvalds case FL_JEDEC_QUERY: 7801da177e4SLinus Torvalds return 0; 7811da177e4SLinus Torvalds 7821da177e4SLinus Torvalds case FL_ERASING: 7832695eab9SJoakim Tjernlund if (!cfip || !(cfip->EraseSuspend & (0x1|0x2)) || 7842695eab9SJoakim Tjernlund !(mode == FL_READY || mode == FL_POINT || 7852695eab9SJoakim Tjernlund (mode == FL_WRITING && (cfip->EraseSuspend & 0x2)))) 7861da177e4SLinus Torvalds goto sleep; 7871da177e4SLinus Torvalds 7881da177e4SLinus Torvalds /* We could check to see if we're trying to access the sector 7891da177e4SLinus Torvalds * that is currently being erased. However, no user will try 7901da177e4SLinus Torvalds * anything like that so we just wait for the timeout. */ 7911da177e4SLinus Torvalds 7921da177e4SLinus Torvalds /* Erase suspend */ 7931da177e4SLinus Torvalds /* It's harmless to issue the Erase-Suspend and Erase-Resume 7941da177e4SLinus Torvalds * commands when the erase algorithm isn't in progress. */ 7951da177e4SLinus Torvalds map_write(map, CMD(0xB0), chip->in_progress_block_addr); 7961da177e4SLinus Torvalds chip->oldstate = FL_ERASING; 7971da177e4SLinus Torvalds chip->state = FL_ERASE_SUSPENDING; 7981da177e4SLinus Torvalds chip->erase_suspended = 1; 7991da177e4SLinus Torvalds for (;;) { 8001da177e4SLinus Torvalds if (chip_ready(map, adr)) 8011da177e4SLinus Torvalds break; 8021da177e4SLinus Torvalds 8031da177e4SLinus Torvalds if (time_after(jiffies, timeo)) { 8041da177e4SLinus Torvalds /* Should have suspended the erase by now. 8051da177e4SLinus Torvalds * Send an Erase-Resume command as either 8061da177e4SLinus Torvalds * there was an error (so leave the erase 8071da177e4SLinus Torvalds * routine to recover from it) or we trying to 8081da177e4SLinus Torvalds * use the erase-in-progress sector. */ 809100f2341STadashi Abe put_chip(map, chip, adr); 8101da177e4SLinus Torvalds printk(KERN_ERR "MTD %s(): chip not ready after erase suspend\n", __func__); 8111da177e4SLinus Torvalds return -EIO; 8121da177e4SLinus Torvalds } 8131da177e4SLinus Torvalds 814c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 8151da177e4SLinus Torvalds cfi_udelay(1); 816c4e77376SStefani Seibold mutex_lock(&chip->mutex); 8171da177e4SLinus Torvalds /* Nobody will touch it while it's in state FL_ERASE_SUSPENDING. 8181da177e4SLinus Torvalds So we can just loop here. */ 8191da177e4SLinus Torvalds } 8201da177e4SLinus Torvalds chip->state = FL_READY; 8211da177e4SLinus Torvalds return 0; 8221da177e4SLinus Torvalds 82302b15e34STodd Poynor case FL_XIP_WHILE_ERASING: 82402b15e34STodd Poynor if (mode != FL_READY && mode != FL_POINT && 82502b15e34STodd Poynor (!cfip || !(cfip->EraseSuspend&2))) 82602b15e34STodd Poynor goto sleep; 82702b15e34STodd Poynor chip->oldstate = chip->state; 82802b15e34STodd Poynor chip->state = FL_READY; 82902b15e34STodd Poynor return 0; 83002b15e34STodd Poynor 831eafe1311SKevin Cernekee case FL_SHUTDOWN: 832eafe1311SKevin Cernekee /* The machine is rebooting */ 833eafe1311SKevin Cernekee return -EIO; 834eafe1311SKevin Cernekee 8351da177e4SLinus Torvalds case FL_POINT: 8361da177e4SLinus Torvalds /* Only if there's no operation suspended... */ 8371da177e4SLinus Torvalds if (mode == FL_READY && chip->oldstate == FL_READY) 8381da177e4SLinus Torvalds return 0; 8391da177e4SLinus Torvalds 8401da177e4SLinus Torvalds default: 8411da177e4SLinus Torvalds sleep: 8421da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 8431da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 844c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 8451da177e4SLinus Torvalds schedule(); 8461da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 847c4e77376SStefani Seibold mutex_lock(&chip->mutex); 8481da177e4SLinus Torvalds goto resettime; 8491da177e4SLinus Torvalds } 8501da177e4SLinus Torvalds } 8511da177e4SLinus Torvalds 8521da177e4SLinus Torvalds 8531da177e4SLinus Torvalds static void put_chip(struct map_info *map, struct flchip *chip, unsigned long adr) 8541da177e4SLinus Torvalds { 8551da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 8561da177e4SLinus Torvalds 8571da177e4SLinus Torvalds switch(chip->oldstate) { 8581da177e4SLinus Torvalds case FL_ERASING: 85942096288SGerlando Falauto cfi_fixup_m29ew_erase_suspend(map, 86042096288SGerlando Falauto chip->in_progress_block_addr); 86108968041SGuillaume LECERF map_write(map, cfi->sector_erase_cmd, chip->in_progress_block_addr); 86242096288SGerlando Falauto cfi_fixup_m29ew_delay_after_resume(cfi); 8631da177e4SLinus Torvalds chip->oldstate = FL_READY; 8641da177e4SLinus Torvalds chip->state = FL_ERASING; 8651da177e4SLinus Torvalds break; 8661da177e4SLinus Torvalds 86702b15e34STodd Poynor case FL_XIP_WHILE_ERASING: 86802b15e34STodd Poynor chip->state = chip->oldstate; 86902b15e34STodd Poynor chip->oldstate = FL_READY; 87002b15e34STodd Poynor break; 87102b15e34STodd Poynor 8721da177e4SLinus Torvalds case FL_READY: 8731da177e4SLinus Torvalds case FL_STATUS: 8741da177e4SLinus Torvalds break; 8751da177e4SLinus Torvalds default: 8761da177e4SLinus Torvalds printk(KERN_ERR "MTD: put_chip() called with oldstate %d!!\n", chip->oldstate); 8771da177e4SLinus Torvalds } 8781da177e4SLinus Torvalds wake_up(&chip->wq); 8791da177e4SLinus Torvalds } 8801da177e4SLinus Torvalds 88102b15e34STodd Poynor #ifdef CONFIG_MTD_XIP 88202b15e34STodd Poynor 88302b15e34STodd Poynor /* 88402b15e34STodd Poynor * No interrupt what so ever can be serviced while the flash isn't in array 88502b15e34STodd Poynor * mode. This is ensured by the xip_disable() and xip_enable() functions 88602b15e34STodd Poynor * enclosing any code path where the flash is known not to be in array mode. 88702b15e34STodd Poynor * And within a XIP disabled code path, only functions marked with __xipram 88802b15e34STodd Poynor * may be called and nothing else (it's a good thing to inspect generated 88902b15e34STodd Poynor * assembly to make sure inline functions were actually inlined and that gcc 89002b15e34STodd Poynor * didn't emit calls to its own support functions). Also configuring MTD CFI 89102b15e34STodd Poynor * support to a single buswidth and a single interleave is also recommended. 89202b15e34STodd Poynor */ 893f8eb321bSThomas Gleixner 89402b15e34STodd Poynor static void xip_disable(struct map_info *map, struct flchip *chip, 89502b15e34STodd Poynor unsigned long adr) 89602b15e34STodd Poynor { 89702b15e34STodd Poynor /* TODO: chips with no XIP use should ignore and return */ 89802b15e34STodd Poynor (void) map_read(map, adr); /* ensure mmu mapping is up to date */ 89902b15e34STodd Poynor local_irq_disable(); 90002b15e34STodd Poynor } 90102b15e34STodd Poynor 90202b15e34STodd Poynor static void __xipram xip_enable(struct map_info *map, struct flchip *chip, 90302b15e34STodd Poynor unsigned long adr) 90402b15e34STodd Poynor { 90502b15e34STodd Poynor struct cfi_private *cfi = map->fldrv_priv; 90602b15e34STodd Poynor 90702b15e34STodd Poynor if (chip->state != FL_POINT && chip->state != FL_READY) { 90802b15e34STodd Poynor map_write(map, CMD(0xf0), adr); 90902b15e34STodd Poynor chip->state = FL_READY; 91002b15e34STodd Poynor } 91102b15e34STodd Poynor (void) map_read(map, adr); 91297f927a4SThomas Gleixner xip_iprefetch(); 91302b15e34STodd Poynor local_irq_enable(); 91402b15e34STodd Poynor } 91502b15e34STodd Poynor 91602b15e34STodd Poynor /* 91702b15e34STodd Poynor * When a delay is required for the flash operation to complete, the 91802b15e34STodd Poynor * xip_udelay() function is polling for both the given timeout and pending 91902b15e34STodd Poynor * (but still masked) hardware interrupts. Whenever there is an interrupt 92002b15e34STodd Poynor * pending then the flash erase operation is suspended, array mode restored 92102b15e34STodd Poynor * and interrupts unmasked. Task scheduling might also happen at that 92202b15e34STodd Poynor * point. The CPU eventually returns from the interrupt or the call to 92302b15e34STodd Poynor * schedule() and the suspended flash operation is resumed for the remaining 92402b15e34STodd Poynor * of the delay period. 92502b15e34STodd Poynor * 92602b15e34STodd Poynor * Warning: this function _will_ fool interrupt latency tracing tools. 92702b15e34STodd Poynor */ 92802b15e34STodd Poynor 92902b15e34STodd Poynor static void __xipram xip_udelay(struct map_info *map, struct flchip *chip, 93002b15e34STodd Poynor unsigned long adr, int usec) 93102b15e34STodd Poynor { 93202b15e34STodd Poynor struct cfi_private *cfi = map->fldrv_priv; 93302b15e34STodd Poynor struct cfi_pri_amdstd *extp = cfi->cmdset_priv; 93402b15e34STodd Poynor map_word status, OK = CMD(0x80); 93502b15e34STodd Poynor unsigned long suspended, start = xip_currtime(); 93602b15e34STodd Poynor flstate_t oldstate; 93702b15e34STodd Poynor 93802b15e34STodd Poynor do { 93902b15e34STodd Poynor cpu_relax(); 94002b15e34STodd Poynor if (xip_irqpending() && extp && 94102b15e34STodd Poynor ((chip->state == FL_ERASING && (extp->EraseSuspend & 2))) && 94202b15e34STodd Poynor (cfi_interleave_is_1(cfi) || chip->oldstate == FL_READY)) { 94302b15e34STodd Poynor /* 94402b15e34STodd Poynor * Let's suspend the erase operation when supported. 94502b15e34STodd Poynor * Note that we currently don't try to suspend 94602b15e34STodd Poynor * interleaved chips if there is already another 94702b15e34STodd Poynor * operation suspended (imagine what happens 94802b15e34STodd Poynor * when one chip was already done with the current 94902b15e34STodd Poynor * operation while another chip suspended it, then 95002b15e34STodd Poynor * we resume the whole thing at once). Yes, it 95102b15e34STodd Poynor * can happen! 95202b15e34STodd Poynor */ 95302b15e34STodd Poynor map_write(map, CMD(0xb0), adr); 95402b15e34STodd Poynor usec -= xip_elapsed_since(start); 95502b15e34STodd Poynor suspended = xip_currtime(); 95602b15e34STodd Poynor do { 95702b15e34STodd Poynor if (xip_elapsed_since(suspended) > 100000) { 95802b15e34STodd Poynor /* 95902b15e34STodd Poynor * The chip doesn't want to suspend 96002b15e34STodd Poynor * after waiting for 100 msecs. 96102b15e34STodd Poynor * This is a critical error but there 96202b15e34STodd Poynor * is not much we can do here. 96302b15e34STodd Poynor */ 96402b15e34STodd Poynor return; 96502b15e34STodd Poynor } 96602b15e34STodd Poynor status = map_read(map, adr); 96702b15e34STodd Poynor } while (!map_word_andequal(map, status, OK, OK)); 96802b15e34STodd Poynor 96902b15e34STodd Poynor /* Suspend succeeded */ 97002b15e34STodd Poynor oldstate = chip->state; 97102b15e34STodd Poynor if (!map_word_bitsset(map, status, CMD(0x40))) 97202b15e34STodd Poynor break; 97302b15e34STodd Poynor chip->state = FL_XIP_WHILE_ERASING; 97402b15e34STodd Poynor chip->erase_suspended = 1; 97502b15e34STodd Poynor map_write(map, CMD(0xf0), adr); 97602b15e34STodd Poynor (void) map_read(map, adr); 977ca5c23c3SPaulius Zaleckas xip_iprefetch(); 97802b15e34STodd Poynor local_irq_enable(); 979c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 980ca5c23c3SPaulius Zaleckas xip_iprefetch(); 98102b15e34STodd Poynor cond_resched(); 98202b15e34STodd Poynor 98302b15e34STodd Poynor /* 98402b15e34STodd Poynor * We're back. However someone else might have 98502b15e34STodd Poynor * decided to go write to the chip if we are in 98602b15e34STodd Poynor * a suspended erase state. If so let's wait 98702b15e34STodd Poynor * until it's done. 98802b15e34STodd Poynor */ 989c4e77376SStefani Seibold mutex_lock(&chip->mutex); 99002b15e34STodd Poynor while (chip->state != FL_XIP_WHILE_ERASING) { 99102b15e34STodd Poynor DECLARE_WAITQUEUE(wait, current); 99202b15e34STodd Poynor set_current_state(TASK_UNINTERRUPTIBLE); 99302b15e34STodd Poynor add_wait_queue(&chip->wq, &wait); 994c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 99502b15e34STodd Poynor schedule(); 99602b15e34STodd Poynor remove_wait_queue(&chip->wq, &wait); 997c4e77376SStefani Seibold mutex_lock(&chip->mutex); 99802b15e34STodd Poynor } 99902b15e34STodd Poynor /* Disallow XIP again */ 100002b15e34STodd Poynor local_irq_disable(); 100102b15e34STodd Poynor 100242096288SGerlando Falauto /* Correct Erase Suspend Hangups for M29EW */ 100342096288SGerlando Falauto cfi_fixup_m29ew_erase_suspend(map, adr); 100402b15e34STodd Poynor /* Resume the write or erase operation */ 100508968041SGuillaume LECERF map_write(map, cfi->sector_erase_cmd, adr); 100602b15e34STodd Poynor chip->state = oldstate; 100702b15e34STodd Poynor start = xip_currtime(); 100802b15e34STodd Poynor } else if (usec >= 1000000/HZ) { 100902b15e34STodd Poynor /* 101002b15e34STodd Poynor * Try to save on CPU power when waiting delay 101102b15e34STodd Poynor * is at least a system timer tick period. 101202b15e34STodd Poynor * No need to be extremely accurate here. 101302b15e34STodd Poynor */ 101402b15e34STodd Poynor xip_cpu_idle(); 101502b15e34STodd Poynor } 101602b15e34STodd Poynor status = map_read(map, adr); 101702b15e34STodd Poynor } while (!map_word_andequal(map, status, OK, OK) 101802b15e34STodd Poynor && xip_elapsed_since(start) < usec); 101902b15e34STodd Poynor } 102002b15e34STodd Poynor 102102b15e34STodd Poynor #define UDELAY(map, chip, adr, usec) xip_udelay(map, chip, adr, usec) 102202b15e34STodd Poynor 102302b15e34STodd Poynor /* 102402b15e34STodd Poynor * The INVALIDATE_CACHED_RANGE() macro is normally used in parallel while 102502b15e34STodd Poynor * the flash is actively programming or erasing since we have to poll for 102602b15e34STodd Poynor * the operation to complete anyway. We can't do that in a generic way with 102702b15e34STodd Poynor * a XIP setup so do it before the actual flash operation in this case 102802b15e34STodd Poynor * and stub it out from INVALIDATE_CACHE_UDELAY. 102902b15e34STodd Poynor */ 103002b15e34STodd Poynor #define XIP_INVAL_CACHED_RANGE(map, from, size) \ 103102b15e34STodd Poynor INVALIDATE_CACHED_RANGE(map, from, size) 103202b15e34STodd Poynor 103302b15e34STodd Poynor #define INVALIDATE_CACHE_UDELAY(map, chip, adr, len, usec) \ 103402b15e34STodd Poynor UDELAY(map, chip, adr, usec) 103502b15e34STodd Poynor 103602b15e34STodd Poynor /* 103702b15e34STodd Poynor * Extra notes: 103802b15e34STodd Poynor * 103902b15e34STodd Poynor * Activating this XIP support changes the way the code works a bit. For 104002b15e34STodd Poynor * example the code to suspend the current process when concurrent access 104102b15e34STodd Poynor * happens is never executed because xip_udelay() will always return with the 104202b15e34STodd Poynor * same chip state as it was entered with. This is why there is no care for 104302b15e34STodd Poynor * the presence of add_wait_queue() or schedule() calls from within a couple 104402b15e34STodd Poynor * xip_disable()'d areas of code, like in do_erase_oneblock for example. 104502b15e34STodd Poynor * The queueing and scheduling are always happening within xip_udelay(). 104602b15e34STodd Poynor * 104702b15e34STodd Poynor * Similarly, get_chip() and put_chip() just happen to always be executed 104802b15e34STodd Poynor * with chip->state set to FL_READY (or FL_XIP_WHILE_*) where flash state 104902b15e34STodd Poynor * is in array mode, therefore never executing many cases therein and not 105002b15e34STodd Poynor * causing any problem with XIP. 105102b15e34STodd Poynor */ 105202b15e34STodd Poynor 105302b15e34STodd Poynor #else 105402b15e34STodd Poynor 105502b15e34STodd Poynor #define xip_disable(map, chip, adr) 105602b15e34STodd Poynor #define xip_enable(map, chip, adr) 105702b15e34STodd Poynor #define XIP_INVAL_CACHED_RANGE(x...) 105802b15e34STodd Poynor 105902b15e34STodd Poynor #define UDELAY(map, chip, adr, usec) \ 106002b15e34STodd Poynor do { \ 1061c4e77376SStefani Seibold mutex_unlock(&chip->mutex); \ 106202b15e34STodd Poynor cfi_udelay(usec); \ 1063c4e77376SStefani Seibold mutex_lock(&chip->mutex); \ 106402b15e34STodd Poynor } while (0) 106502b15e34STodd Poynor 106602b15e34STodd Poynor #define INVALIDATE_CACHE_UDELAY(map, chip, adr, len, usec) \ 106702b15e34STodd Poynor do { \ 1068c4e77376SStefani Seibold mutex_unlock(&chip->mutex); \ 106902b15e34STodd Poynor INVALIDATE_CACHED_RANGE(map, adr, len); \ 107002b15e34STodd Poynor cfi_udelay(usec); \ 1071c4e77376SStefani Seibold mutex_lock(&chip->mutex); \ 107202b15e34STodd Poynor } while (0) 107302b15e34STodd Poynor 107402b15e34STodd Poynor #endif 10751da177e4SLinus Torvalds 10761da177e4SLinus Torvalds static inline int do_read_onechip(struct map_info *map, struct flchip *chip, loff_t adr, size_t len, u_char *buf) 10771da177e4SLinus Torvalds { 10781da177e4SLinus Torvalds unsigned long cmd_addr; 10791da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 10801da177e4SLinus Torvalds int ret; 10811da177e4SLinus Torvalds 10821da177e4SLinus Torvalds adr += chip->start; 10831da177e4SLinus Torvalds 10841da177e4SLinus Torvalds /* Ensure cmd read/writes are aligned. */ 10851da177e4SLinus Torvalds cmd_addr = adr & ~(map_bankwidth(map)-1); 10861da177e4SLinus Torvalds 1087c4e77376SStefani Seibold mutex_lock(&chip->mutex); 10881da177e4SLinus Torvalds ret = get_chip(map, chip, cmd_addr, FL_READY); 10891da177e4SLinus Torvalds if (ret) { 1090c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 10911da177e4SLinus Torvalds return ret; 10921da177e4SLinus Torvalds } 10931da177e4SLinus Torvalds 10941da177e4SLinus Torvalds if (chip->state != FL_POINT && chip->state != FL_READY) { 10951da177e4SLinus Torvalds map_write(map, CMD(0xf0), cmd_addr); 10961da177e4SLinus Torvalds chip->state = FL_READY; 10971da177e4SLinus Torvalds } 10981da177e4SLinus Torvalds 10991da177e4SLinus Torvalds map_copy_from(map, buf, adr, len); 11001da177e4SLinus Torvalds 11011da177e4SLinus Torvalds put_chip(map, chip, cmd_addr); 11021da177e4SLinus Torvalds 1103c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 11041da177e4SLinus Torvalds return 0; 11051da177e4SLinus Torvalds } 11061da177e4SLinus Torvalds 11071da177e4SLinus Torvalds 11081da177e4SLinus Torvalds static int cfi_amdstd_read (struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf) 11091da177e4SLinus Torvalds { 11101da177e4SLinus Torvalds struct map_info *map = mtd->priv; 11111da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 11121da177e4SLinus Torvalds unsigned long ofs; 11131da177e4SLinus Torvalds int chipnum; 11141da177e4SLinus Torvalds int ret = 0; 11151da177e4SLinus Torvalds 11161da177e4SLinus Torvalds /* ofs: offset within the first chip that the first read should start */ 11171da177e4SLinus Torvalds chipnum = (from >> cfi->chipshift); 11181da177e4SLinus Torvalds ofs = from - (chipnum << cfi->chipshift); 11191da177e4SLinus Torvalds 11201da177e4SLinus Torvalds while (len) { 11211da177e4SLinus Torvalds unsigned long thislen; 11221da177e4SLinus Torvalds 11231da177e4SLinus Torvalds if (chipnum >= cfi->numchips) 11241da177e4SLinus Torvalds break; 11251da177e4SLinus Torvalds 11261da177e4SLinus Torvalds if ((len + ofs -1) >> cfi->chipshift) 11271da177e4SLinus Torvalds thislen = (1<<cfi->chipshift) - ofs; 11281da177e4SLinus Torvalds else 11291da177e4SLinus Torvalds thislen = len; 11301da177e4SLinus Torvalds 11311da177e4SLinus Torvalds ret = do_read_onechip(map, &cfi->chips[chipnum], ofs, thislen, buf); 11321da177e4SLinus Torvalds if (ret) 11331da177e4SLinus Torvalds break; 11341da177e4SLinus Torvalds 11351da177e4SLinus Torvalds *retlen += thislen; 11361da177e4SLinus Torvalds len -= thislen; 11371da177e4SLinus Torvalds buf += thislen; 11381da177e4SLinus Torvalds 11391da177e4SLinus Torvalds ofs = 0; 11401da177e4SLinus Torvalds chipnum++; 11411da177e4SLinus Torvalds } 11421da177e4SLinus Torvalds return ret; 11431da177e4SLinus Torvalds } 11441da177e4SLinus Torvalds 11451da177e4SLinus Torvalds 11461da177e4SLinus Torvalds static inline int do_read_secsi_onechip(struct map_info *map, struct flchip *chip, loff_t adr, size_t len, u_char *buf) 11471da177e4SLinus Torvalds { 11481da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 11491da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 11501da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 11511da177e4SLinus Torvalds 11521da177e4SLinus Torvalds retry: 1153c4e77376SStefani Seibold mutex_lock(&chip->mutex); 11541da177e4SLinus Torvalds 11551da177e4SLinus Torvalds if (chip->state != FL_READY){ 11561da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 11571da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 11581da177e4SLinus Torvalds 1159c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 11601da177e4SLinus Torvalds 11611da177e4SLinus Torvalds schedule(); 11621da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 11631da177e4SLinus Torvalds timeo = jiffies + HZ; 11641da177e4SLinus Torvalds 11651da177e4SLinus Torvalds goto retry; 11661da177e4SLinus Torvalds } 11671da177e4SLinus Torvalds 11681da177e4SLinus Torvalds adr += chip->start; 11691da177e4SLinus Torvalds 11701da177e4SLinus Torvalds chip->state = FL_READY; 11711da177e4SLinus Torvalds 11721da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 11731da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 11741da177e4SLinus Torvalds cfi_send_gen_cmd(0x88, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 11751da177e4SLinus Torvalds 11761da177e4SLinus Torvalds map_copy_from(map, buf, adr, len); 11771da177e4SLinus Torvalds 11781da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 11791da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 11801da177e4SLinus Torvalds cfi_send_gen_cmd(0x90, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 11811da177e4SLinus Torvalds cfi_send_gen_cmd(0x00, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 11821da177e4SLinus Torvalds 11831da177e4SLinus Torvalds wake_up(&chip->wq); 1184c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 11851da177e4SLinus Torvalds 11861da177e4SLinus Torvalds return 0; 11871da177e4SLinus Torvalds } 11881da177e4SLinus Torvalds 11891da177e4SLinus Torvalds static int cfi_amdstd_secsi_read (struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf) 11901da177e4SLinus Torvalds { 11911da177e4SLinus Torvalds struct map_info *map = mtd->priv; 11921da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 11931da177e4SLinus Torvalds unsigned long ofs; 11941da177e4SLinus Torvalds int chipnum; 11951da177e4SLinus Torvalds int ret = 0; 11961da177e4SLinus Torvalds 11971da177e4SLinus Torvalds /* ofs: offset within the first chip that the first read should start */ 11981da177e4SLinus Torvalds /* 8 secsi bytes per chip */ 11991da177e4SLinus Torvalds chipnum=from>>3; 12001da177e4SLinus Torvalds ofs=from & 7; 12011da177e4SLinus Torvalds 12021da177e4SLinus Torvalds while (len) { 12031da177e4SLinus Torvalds unsigned long thislen; 12041da177e4SLinus Torvalds 12051da177e4SLinus Torvalds if (chipnum >= cfi->numchips) 12061da177e4SLinus Torvalds break; 12071da177e4SLinus Torvalds 12081da177e4SLinus Torvalds if ((len + ofs -1) >> 3) 12091da177e4SLinus Torvalds thislen = (1<<3) - ofs; 12101da177e4SLinus Torvalds else 12111da177e4SLinus Torvalds thislen = len; 12121da177e4SLinus Torvalds 12131da177e4SLinus Torvalds ret = do_read_secsi_onechip(map, &cfi->chips[chipnum], ofs, thislen, buf); 12141da177e4SLinus Torvalds if (ret) 12151da177e4SLinus Torvalds break; 12161da177e4SLinus Torvalds 12171da177e4SLinus Torvalds *retlen += thislen; 12181da177e4SLinus Torvalds len -= thislen; 12191da177e4SLinus Torvalds buf += thislen; 12201da177e4SLinus Torvalds 12211da177e4SLinus Torvalds ofs = 0; 12221da177e4SLinus Torvalds chipnum++; 12231da177e4SLinus Torvalds } 12241da177e4SLinus Torvalds return ret; 12251da177e4SLinus Torvalds } 12261da177e4SLinus Torvalds 12271da177e4SLinus Torvalds 122802b15e34STodd Poynor static int __xipram do_write_oneword(struct map_info *map, struct flchip *chip, unsigned long adr, map_word datum) 12291da177e4SLinus Torvalds { 12301da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 12311da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 12321da177e4SLinus Torvalds /* 12331da177e4SLinus Torvalds * We use a 1ms + 1 jiffies generic timeout for writes (most devices 12341da177e4SLinus Torvalds * have a max write time of a few hundreds usec). However, we should 12351da177e4SLinus Torvalds * use the maximum timeout value given by the chip at probe time 12361da177e4SLinus Torvalds * instead. Unfortunately, struct flchip does have a field for 12371da177e4SLinus Torvalds * maximum timeout, only for typical which can be far too short 12381da177e4SLinus Torvalds * depending of the conditions. The ' + 1' is to avoid having a 12391da177e4SLinus Torvalds * timeout of 0 jiffies if HZ is smaller than 1000. 12401da177e4SLinus Torvalds */ 12411da177e4SLinus Torvalds unsigned long uWriteTimeout = ( HZ / 1000 ) + 1; 12421da177e4SLinus Torvalds int ret = 0; 12431da177e4SLinus Torvalds map_word oldd; 12441da177e4SLinus Torvalds int retry_cnt = 0; 12451da177e4SLinus Torvalds 12461da177e4SLinus Torvalds adr += chip->start; 12471da177e4SLinus Torvalds 1248c4e77376SStefani Seibold mutex_lock(&chip->mutex); 12491da177e4SLinus Torvalds ret = get_chip(map, chip, adr, FL_WRITING); 12501da177e4SLinus Torvalds if (ret) { 1251c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 12521da177e4SLinus Torvalds return ret; 12531da177e4SLinus Torvalds } 12541da177e4SLinus Torvalds 1255289c0522SBrian Norris pr_debug("MTD %s(): WRITE 0x%.8lx(0x%.8lx)\n", 12561da177e4SLinus Torvalds __func__, adr, datum.x[0] ); 12571da177e4SLinus Torvalds 12581da177e4SLinus Torvalds /* 12591da177e4SLinus Torvalds * Check for a NOP for the case when the datum to write is already 12601da177e4SLinus Torvalds * present - it saves time and works around buggy chips that corrupt 12611da177e4SLinus Torvalds * data at other locations when 0xff is written to a location that 12621da177e4SLinus Torvalds * already contains 0xff. 12631da177e4SLinus Torvalds */ 12641da177e4SLinus Torvalds oldd = map_read(map, adr); 12651da177e4SLinus Torvalds if (map_word_equal(map, oldd, datum)) { 1266289c0522SBrian Norris pr_debug("MTD %s(): NOP\n", 12671da177e4SLinus Torvalds __func__); 12681da177e4SLinus Torvalds goto op_done; 12691da177e4SLinus Torvalds } 12701da177e4SLinus Torvalds 127102b15e34STodd Poynor XIP_INVAL_CACHED_RANGE(map, adr, map_bankwidth(map)); 12721da177e4SLinus Torvalds ENABLE_VPP(map); 127302b15e34STodd Poynor xip_disable(map, chip, adr); 12741da177e4SLinus Torvalds retry: 12751da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 12761da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 12771da177e4SLinus Torvalds cfi_send_gen_cmd(0xA0, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 12781da177e4SLinus Torvalds map_write(map, datum, adr); 12791da177e4SLinus Torvalds chip->state = FL_WRITING; 12801da177e4SLinus Torvalds 128102b15e34STodd Poynor INVALIDATE_CACHE_UDELAY(map, chip, 128202b15e34STodd Poynor adr, map_bankwidth(map), 128302b15e34STodd Poynor chip->word_write_time); 12841da177e4SLinus Torvalds 12851da177e4SLinus Torvalds /* See comment above for timeout value. */ 12861da177e4SLinus Torvalds timeo = jiffies + uWriteTimeout; 12871da177e4SLinus Torvalds for (;;) { 12881da177e4SLinus Torvalds if (chip->state != FL_WRITING) { 12891da177e4SLinus Torvalds /* Someone's suspended the write. Sleep */ 12901da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 12911da177e4SLinus Torvalds 12921da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 12931da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 1294c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 12951da177e4SLinus Torvalds schedule(); 12961da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 12971da177e4SLinus Torvalds timeo = jiffies + (HZ / 2); /* FIXME */ 1298c4e77376SStefani Seibold mutex_lock(&chip->mutex); 12991da177e4SLinus Torvalds continue; 13001da177e4SLinus Torvalds } 13011da177e4SLinus Torvalds 1302b95f9609SKonstantin Baidarov if (time_after(jiffies, timeo) && !chip_ready(map, adr)){ 130302b15e34STodd Poynor xip_enable(map, chip, adr); 1304fb4a90bfSEric W. Biedermann printk(KERN_WARNING "MTD %s(): software timeout\n", __func__); 130502b15e34STodd Poynor xip_disable(map, chip, adr); 1306fb4a90bfSEric W. Biedermann break; 1307fb4a90bfSEric W. Biedermann } 1308fb4a90bfSEric W. Biedermann 1309b95f9609SKonstantin Baidarov if (chip_ready(map, adr)) 1310b95f9609SKonstantin Baidarov break; 1311b95f9609SKonstantin Baidarov 13121da177e4SLinus Torvalds /* Latency issues. Drop the lock, wait a while and retry */ 131302b15e34STodd Poynor UDELAY(map, chip, adr, 1); 13141da177e4SLinus Torvalds } 1315fb4a90bfSEric W. Biedermann /* Did we succeed? */ 1316fb4a90bfSEric W. Biedermann if (!chip_good(map, adr, datum)) { 13171da177e4SLinus Torvalds /* reset on all failures. */ 13181da177e4SLinus Torvalds map_write( map, CMD(0xF0), chip->start ); 13191da177e4SLinus Torvalds /* FIXME - should have reset delay before continuing */ 1320fb4a90bfSEric W. Biedermann 13211da177e4SLinus Torvalds if (++retry_cnt <= MAX_WORD_RETRIES) 13221da177e4SLinus Torvalds goto retry; 13231da177e4SLinus Torvalds 13241da177e4SLinus Torvalds ret = -EIO; 1325fb4a90bfSEric W. Biedermann } 132602b15e34STodd Poynor xip_enable(map, chip, adr); 13271da177e4SLinus Torvalds op_done: 13281da177e4SLinus Torvalds chip->state = FL_READY; 1329e7d9377eSPaul Parsons DISABLE_VPP(map); 13301da177e4SLinus Torvalds put_chip(map, chip, adr); 1331c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 13321da177e4SLinus Torvalds 13331da177e4SLinus Torvalds return ret; 13341da177e4SLinus Torvalds } 13351da177e4SLinus Torvalds 13361da177e4SLinus Torvalds 13371da177e4SLinus Torvalds static int cfi_amdstd_write_words(struct mtd_info *mtd, loff_t to, size_t len, 13381da177e4SLinus Torvalds size_t *retlen, const u_char *buf) 13391da177e4SLinus Torvalds { 13401da177e4SLinus Torvalds struct map_info *map = mtd->priv; 13411da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 13421da177e4SLinus Torvalds int ret = 0; 13431da177e4SLinus Torvalds int chipnum; 13441da177e4SLinus Torvalds unsigned long ofs, chipstart; 13451da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 13461da177e4SLinus Torvalds 13471da177e4SLinus Torvalds chipnum = to >> cfi->chipshift; 13481da177e4SLinus Torvalds ofs = to - (chipnum << cfi->chipshift); 13491da177e4SLinus Torvalds chipstart = cfi->chips[chipnum].start; 13501da177e4SLinus Torvalds 13511da177e4SLinus Torvalds /* If it's not bus-aligned, do the first byte write */ 13521da177e4SLinus Torvalds if (ofs & (map_bankwidth(map)-1)) { 13531da177e4SLinus Torvalds unsigned long bus_ofs = ofs & ~(map_bankwidth(map)-1); 13541da177e4SLinus Torvalds int i = ofs - bus_ofs; 13551da177e4SLinus Torvalds int n = 0; 13561da177e4SLinus Torvalds map_word tmp_buf; 13571da177e4SLinus Torvalds 13581da177e4SLinus Torvalds retry: 1359c4e77376SStefani Seibold mutex_lock(&cfi->chips[chipnum].mutex); 13601da177e4SLinus Torvalds 13611da177e4SLinus Torvalds if (cfi->chips[chipnum].state != FL_READY) { 13621da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 13631da177e4SLinus Torvalds add_wait_queue(&cfi->chips[chipnum].wq, &wait); 13641da177e4SLinus Torvalds 1365c4e77376SStefani Seibold mutex_unlock(&cfi->chips[chipnum].mutex); 13661da177e4SLinus Torvalds 13671da177e4SLinus Torvalds schedule(); 13681da177e4SLinus Torvalds remove_wait_queue(&cfi->chips[chipnum].wq, &wait); 13691da177e4SLinus Torvalds goto retry; 13701da177e4SLinus Torvalds } 13711da177e4SLinus Torvalds 13721da177e4SLinus Torvalds /* Load 'tmp_buf' with old contents of flash */ 13731da177e4SLinus Torvalds tmp_buf = map_read(map, bus_ofs+chipstart); 13741da177e4SLinus Torvalds 1375c4e77376SStefani Seibold mutex_unlock(&cfi->chips[chipnum].mutex); 13761da177e4SLinus Torvalds 13771da177e4SLinus Torvalds /* Number of bytes to copy from buffer */ 13781da177e4SLinus Torvalds n = min_t(int, len, map_bankwidth(map)-i); 13791da177e4SLinus Torvalds 13801da177e4SLinus Torvalds tmp_buf = map_word_load_partial(map, tmp_buf, buf, i, n); 13811da177e4SLinus Torvalds 13821da177e4SLinus Torvalds ret = do_write_oneword(map, &cfi->chips[chipnum], 13831da177e4SLinus Torvalds bus_ofs, tmp_buf); 13841da177e4SLinus Torvalds if (ret) 13851da177e4SLinus Torvalds return ret; 13861da177e4SLinus Torvalds 13871da177e4SLinus Torvalds ofs += n; 13881da177e4SLinus Torvalds buf += n; 13891da177e4SLinus Torvalds (*retlen) += n; 13901da177e4SLinus Torvalds len -= n; 13911da177e4SLinus Torvalds 13921da177e4SLinus Torvalds if (ofs >> cfi->chipshift) { 13931da177e4SLinus Torvalds chipnum ++; 13941da177e4SLinus Torvalds ofs = 0; 13951da177e4SLinus Torvalds if (chipnum == cfi->numchips) 13961da177e4SLinus Torvalds return 0; 13971da177e4SLinus Torvalds } 13981da177e4SLinus Torvalds } 13991da177e4SLinus Torvalds 14001da177e4SLinus Torvalds /* We are now aligned, write as much as possible */ 14011da177e4SLinus Torvalds while(len >= map_bankwidth(map)) { 14021da177e4SLinus Torvalds map_word datum; 14031da177e4SLinus Torvalds 14041da177e4SLinus Torvalds datum = map_word_load(map, buf); 14051da177e4SLinus Torvalds 14061da177e4SLinus Torvalds ret = do_write_oneword(map, &cfi->chips[chipnum], 14071da177e4SLinus Torvalds ofs, datum); 14081da177e4SLinus Torvalds if (ret) 14091da177e4SLinus Torvalds return ret; 14101da177e4SLinus Torvalds 14111da177e4SLinus Torvalds ofs += map_bankwidth(map); 14121da177e4SLinus Torvalds buf += map_bankwidth(map); 14131da177e4SLinus Torvalds (*retlen) += map_bankwidth(map); 14141da177e4SLinus Torvalds len -= map_bankwidth(map); 14151da177e4SLinus Torvalds 14161da177e4SLinus Torvalds if (ofs >> cfi->chipshift) { 14171da177e4SLinus Torvalds chipnum ++; 14181da177e4SLinus Torvalds ofs = 0; 14191da177e4SLinus Torvalds if (chipnum == cfi->numchips) 14201da177e4SLinus Torvalds return 0; 14211da177e4SLinus Torvalds chipstart = cfi->chips[chipnum].start; 14221da177e4SLinus Torvalds } 14231da177e4SLinus Torvalds } 14241da177e4SLinus Torvalds 14251da177e4SLinus Torvalds /* Write the trailing bytes if any */ 14261da177e4SLinus Torvalds if (len & (map_bankwidth(map)-1)) { 14271da177e4SLinus Torvalds map_word tmp_buf; 14281da177e4SLinus Torvalds 14291da177e4SLinus Torvalds retry1: 1430c4e77376SStefani Seibold mutex_lock(&cfi->chips[chipnum].mutex); 14311da177e4SLinus Torvalds 14321da177e4SLinus Torvalds if (cfi->chips[chipnum].state != FL_READY) { 14331da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 14341da177e4SLinus Torvalds add_wait_queue(&cfi->chips[chipnum].wq, &wait); 14351da177e4SLinus Torvalds 1436c4e77376SStefani Seibold mutex_unlock(&cfi->chips[chipnum].mutex); 14371da177e4SLinus Torvalds 14381da177e4SLinus Torvalds schedule(); 14391da177e4SLinus Torvalds remove_wait_queue(&cfi->chips[chipnum].wq, &wait); 14401da177e4SLinus Torvalds goto retry1; 14411da177e4SLinus Torvalds } 14421da177e4SLinus Torvalds 14431da177e4SLinus Torvalds tmp_buf = map_read(map, ofs + chipstart); 14441da177e4SLinus Torvalds 1445c4e77376SStefani Seibold mutex_unlock(&cfi->chips[chipnum].mutex); 14461da177e4SLinus Torvalds 14471da177e4SLinus Torvalds tmp_buf = map_word_load_partial(map, tmp_buf, buf, 0, len); 14481da177e4SLinus Torvalds 14491da177e4SLinus Torvalds ret = do_write_oneword(map, &cfi->chips[chipnum], 14501da177e4SLinus Torvalds ofs, tmp_buf); 14511da177e4SLinus Torvalds if (ret) 14521da177e4SLinus Torvalds return ret; 14531da177e4SLinus Torvalds 14541da177e4SLinus Torvalds (*retlen) += len; 14551da177e4SLinus Torvalds } 14561da177e4SLinus Torvalds 14571da177e4SLinus Torvalds return 0; 14581da177e4SLinus Torvalds } 14591da177e4SLinus Torvalds 14601da177e4SLinus Torvalds 14611da177e4SLinus Torvalds /* 14621da177e4SLinus Torvalds * FIXME: interleaved mode not tested, and probably not supported! 14631da177e4SLinus Torvalds */ 146402b15e34STodd Poynor static int __xipram do_write_buffer(struct map_info *map, struct flchip *chip, 146502b15e34STodd Poynor unsigned long adr, const u_char *buf, 146602b15e34STodd Poynor int len) 14671da177e4SLinus Torvalds { 14681da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 14691da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 14701da177e4SLinus Torvalds /* see comments in do_write_oneword() regarding uWriteTimeo. */ 14711da177e4SLinus Torvalds unsigned long uWriteTimeout = ( HZ / 1000 ) + 1; 14721da177e4SLinus Torvalds int ret = -EIO; 14731da177e4SLinus Torvalds unsigned long cmd_adr; 14741da177e4SLinus Torvalds int z, words; 14751da177e4SLinus Torvalds map_word datum; 14761da177e4SLinus Torvalds 14771da177e4SLinus Torvalds adr += chip->start; 14781da177e4SLinus Torvalds cmd_adr = adr; 14791da177e4SLinus Torvalds 1480c4e77376SStefani Seibold mutex_lock(&chip->mutex); 14811da177e4SLinus Torvalds ret = get_chip(map, chip, adr, FL_WRITING); 14821da177e4SLinus Torvalds if (ret) { 1483c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 14841da177e4SLinus Torvalds return ret; 14851da177e4SLinus Torvalds } 14861da177e4SLinus Torvalds 14871da177e4SLinus Torvalds datum = map_word_load(map, buf); 14881da177e4SLinus Torvalds 1489289c0522SBrian Norris pr_debug("MTD %s(): WRITE 0x%.8lx(0x%.8lx)\n", 14901da177e4SLinus Torvalds __func__, adr, datum.x[0] ); 14911da177e4SLinus Torvalds 149202b15e34STodd Poynor XIP_INVAL_CACHED_RANGE(map, adr, len); 14931da177e4SLinus Torvalds ENABLE_VPP(map); 149402b15e34STodd Poynor xip_disable(map, chip, cmd_adr); 149502b15e34STodd Poynor 14961da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 14971da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 14981da177e4SLinus Torvalds 14991da177e4SLinus Torvalds /* Write Buffer Load */ 15001da177e4SLinus Torvalds map_write(map, CMD(0x25), cmd_adr); 15011da177e4SLinus Torvalds 15021da177e4SLinus Torvalds chip->state = FL_WRITING_TO_BUFFER; 15031da177e4SLinus Torvalds 15041da177e4SLinus Torvalds /* Write length of data to come */ 15051da177e4SLinus Torvalds words = len / map_bankwidth(map); 15061da177e4SLinus Torvalds map_write(map, CMD(words - 1), cmd_adr); 15071da177e4SLinus Torvalds /* Write data */ 15081da177e4SLinus Torvalds z = 0; 15091da177e4SLinus Torvalds while(z < words * map_bankwidth(map)) { 15101da177e4SLinus Torvalds datum = map_word_load(map, buf); 15111da177e4SLinus Torvalds map_write(map, datum, adr + z); 15121da177e4SLinus Torvalds 15131da177e4SLinus Torvalds z += map_bankwidth(map); 15141da177e4SLinus Torvalds buf += map_bankwidth(map); 15151da177e4SLinus Torvalds } 15161da177e4SLinus Torvalds z -= map_bankwidth(map); 15171da177e4SLinus Torvalds 15181da177e4SLinus Torvalds adr += z; 15191da177e4SLinus Torvalds 15201da177e4SLinus Torvalds /* Write Buffer Program Confirm: GO GO GO */ 15211da177e4SLinus Torvalds map_write(map, CMD(0x29), cmd_adr); 15221da177e4SLinus Torvalds chip->state = FL_WRITING; 15231da177e4SLinus Torvalds 152402b15e34STodd Poynor INVALIDATE_CACHE_UDELAY(map, chip, 152502b15e34STodd Poynor adr, map_bankwidth(map), 152602b15e34STodd Poynor chip->word_write_time); 15271da177e4SLinus Torvalds 15281da177e4SLinus Torvalds timeo = jiffies + uWriteTimeout; 15291da177e4SLinus Torvalds 15301da177e4SLinus Torvalds for (;;) { 15311da177e4SLinus Torvalds if (chip->state != FL_WRITING) { 15321da177e4SLinus Torvalds /* Someone's suspended the write. Sleep */ 15331da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 15341da177e4SLinus Torvalds 15351da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 15361da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 1537c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 15381da177e4SLinus Torvalds schedule(); 15391da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 15401da177e4SLinus Torvalds timeo = jiffies + (HZ / 2); /* FIXME */ 1541c4e77376SStefani Seibold mutex_lock(&chip->mutex); 15421da177e4SLinus Torvalds continue; 15431da177e4SLinus Torvalds } 15441da177e4SLinus Torvalds 1545b95f9609SKonstantin Baidarov if (time_after(jiffies, timeo) && !chip_ready(map, adr)) 1546b95f9609SKonstantin Baidarov break; 1547b95f9609SKonstantin Baidarov 154802b15e34STodd Poynor if (chip_ready(map, adr)) { 154902b15e34STodd Poynor xip_enable(map, chip, adr); 15501da177e4SLinus Torvalds goto op_done; 155102b15e34STodd Poynor } 15521da177e4SLinus Torvalds 15531da177e4SLinus Torvalds /* Latency issues. Drop the lock, wait a while and retry */ 155402b15e34STodd Poynor UDELAY(map, chip, adr, 1); 15551da177e4SLinus Torvalds } 15561da177e4SLinus Torvalds 1557070c3222SHarald Nordgard-Hansen /* 1558070c3222SHarald Nordgard-Hansen * Recovery from write-buffer programming failures requires 1559070c3222SHarald Nordgard-Hansen * the write-to-buffer-reset sequence. Since the last part 1560070c3222SHarald Nordgard-Hansen * of the sequence also works as a normal reset, we can run 1561070c3222SHarald Nordgard-Hansen * the same commands regardless of why we are here. 1562070c3222SHarald Nordgard-Hansen * See e.g. 1563070c3222SHarald Nordgard-Hansen * http://www.spansion.com/Support/Application%20Notes/MirrorBit_Write_Buffer_Prog_Page_Buffer_Read_AN.pdf 1564070c3222SHarald Nordgard-Hansen */ 1565070c3222SHarald Nordgard-Hansen cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, 1566070c3222SHarald Nordgard-Hansen cfi->device_type, NULL); 1567070c3222SHarald Nordgard-Hansen cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, 1568070c3222SHarald Nordgard-Hansen cfi->device_type, NULL); 1569070c3222SHarald Nordgard-Hansen cfi_send_gen_cmd(0xF0, cfi->addr_unlock1, chip->start, map, cfi, 1570070c3222SHarald Nordgard-Hansen cfi->device_type, NULL); 157102b15e34STodd Poynor xip_enable(map, chip, adr); 15721da177e4SLinus Torvalds /* FIXME - should have reset delay before continuing */ 15731da177e4SLinus Torvalds 157402b15e34STodd Poynor printk(KERN_WARNING "MTD %s(): software timeout\n", 157502b15e34STodd Poynor __func__ ); 157602b15e34STodd Poynor 15771da177e4SLinus Torvalds ret = -EIO; 15781da177e4SLinus Torvalds op_done: 15791da177e4SLinus Torvalds chip->state = FL_READY; 1580e7d9377eSPaul Parsons DISABLE_VPP(map); 15811da177e4SLinus Torvalds put_chip(map, chip, adr); 1582c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 15831da177e4SLinus Torvalds 15841da177e4SLinus Torvalds return ret; 15851da177e4SLinus Torvalds } 15861da177e4SLinus Torvalds 15871da177e4SLinus Torvalds 15881da177e4SLinus Torvalds static int cfi_amdstd_write_buffers(struct mtd_info *mtd, loff_t to, size_t len, 15891da177e4SLinus Torvalds size_t *retlen, const u_char *buf) 15901da177e4SLinus Torvalds { 15911da177e4SLinus Torvalds struct map_info *map = mtd->priv; 15921da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 15931da177e4SLinus Torvalds int wbufsize = cfi_interleave(cfi) << cfi->cfiq->MaxBufWriteSize; 15941da177e4SLinus Torvalds int ret = 0; 15951da177e4SLinus Torvalds int chipnum; 15961da177e4SLinus Torvalds unsigned long ofs; 15971da177e4SLinus Torvalds 15981da177e4SLinus Torvalds chipnum = to >> cfi->chipshift; 15991da177e4SLinus Torvalds ofs = to - (chipnum << cfi->chipshift); 16001da177e4SLinus Torvalds 16011da177e4SLinus Torvalds /* If it's not bus-aligned, do the first word write */ 16021da177e4SLinus Torvalds if (ofs & (map_bankwidth(map)-1)) { 16031da177e4SLinus Torvalds size_t local_len = (-ofs)&(map_bankwidth(map)-1); 16041da177e4SLinus Torvalds if (local_len > len) 16051da177e4SLinus Torvalds local_len = len; 16061da177e4SLinus Torvalds ret = cfi_amdstd_write_words(mtd, ofs + (chipnum<<cfi->chipshift), 16071da177e4SLinus Torvalds local_len, retlen, buf); 16081da177e4SLinus Torvalds if (ret) 16091da177e4SLinus Torvalds return ret; 16101da177e4SLinus Torvalds ofs += local_len; 16111da177e4SLinus Torvalds buf += local_len; 16121da177e4SLinus Torvalds len -= local_len; 16131da177e4SLinus Torvalds 16141da177e4SLinus Torvalds if (ofs >> cfi->chipshift) { 16151da177e4SLinus Torvalds chipnum ++; 16161da177e4SLinus Torvalds ofs = 0; 16171da177e4SLinus Torvalds if (chipnum == cfi->numchips) 16181da177e4SLinus Torvalds return 0; 16191da177e4SLinus Torvalds } 16201da177e4SLinus Torvalds } 16211da177e4SLinus Torvalds 16221da177e4SLinus Torvalds /* Write buffer is worth it only if more than one word to write... */ 16231da177e4SLinus Torvalds while (len >= map_bankwidth(map) * 2) { 16241da177e4SLinus Torvalds /* We must not cross write block boundaries */ 16251da177e4SLinus Torvalds int size = wbufsize - (ofs & (wbufsize-1)); 16261da177e4SLinus Torvalds 16271da177e4SLinus Torvalds if (size > len) 16281da177e4SLinus Torvalds size = len; 16291da177e4SLinus Torvalds if (size % map_bankwidth(map)) 16301da177e4SLinus Torvalds size -= size % map_bankwidth(map); 16311da177e4SLinus Torvalds 16321da177e4SLinus Torvalds ret = do_write_buffer(map, &cfi->chips[chipnum], 16331da177e4SLinus Torvalds ofs, buf, size); 16341da177e4SLinus Torvalds if (ret) 16351da177e4SLinus Torvalds return ret; 16361da177e4SLinus Torvalds 16371da177e4SLinus Torvalds ofs += size; 16381da177e4SLinus Torvalds buf += size; 16391da177e4SLinus Torvalds (*retlen) += size; 16401da177e4SLinus Torvalds len -= size; 16411da177e4SLinus Torvalds 16421da177e4SLinus Torvalds if (ofs >> cfi->chipshift) { 16431da177e4SLinus Torvalds chipnum ++; 16441da177e4SLinus Torvalds ofs = 0; 16451da177e4SLinus Torvalds if (chipnum == cfi->numchips) 16461da177e4SLinus Torvalds return 0; 16471da177e4SLinus Torvalds } 16481da177e4SLinus Torvalds } 16491da177e4SLinus Torvalds 16501da177e4SLinus Torvalds if (len) { 16511da177e4SLinus Torvalds size_t retlen_dregs = 0; 16521da177e4SLinus Torvalds 16531da177e4SLinus Torvalds ret = cfi_amdstd_write_words(mtd, ofs + (chipnum<<cfi->chipshift), 16541da177e4SLinus Torvalds len, &retlen_dregs, buf); 16551da177e4SLinus Torvalds 16561da177e4SLinus Torvalds *retlen += retlen_dregs; 16571da177e4SLinus Torvalds return ret; 16581da177e4SLinus Torvalds } 16591da177e4SLinus Torvalds 16601da177e4SLinus Torvalds return 0; 16611da177e4SLinus Torvalds } 16621da177e4SLinus Torvalds 166330ec5a2cSIra W. Snyder /* 166430ec5a2cSIra W. Snyder * Wait for the flash chip to become ready to write data 166530ec5a2cSIra W. Snyder * 166630ec5a2cSIra W. Snyder * This is only called during the panic_write() path. When panic_write() 166730ec5a2cSIra W. Snyder * is called, the kernel is in the process of a panic, and will soon be 166830ec5a2cSIra W. Snyder * dead. Therefore we don't take any locks, and attempt to get access 166930ec5a2cSIra W. Snyder * to the chip as soon as possible. 167030ec5a2cSIra W. Snyder */ 167130ec5a2cSIra W. Snyder static int cfi_amdstd_panic_wait(struct map_info *map, struct flchip *chip, 167230ec5a2cSIra W. Snyder unsigned long adr) 167330ec5a2cSIra W. Snyder { 167430ec5a2cSIra W. Snyder struct cfi_private *cfi = map->fldrv_priv; 167530ec5a2cSIra W. Snyder int retries = 10; 167630ec5a2cSIra W. Snyder int i; 167730ec5a2cSIra W. Snyder 167830ec5a2cSIra W. Snyder /* 167930ec5a2cSIra W. Snyder * If the driver thinks the chip is idle, and no toggle bits 168030ec5a2cSIra W. Snyder * are changing, then the chip is actually idle for sure. 168130ec5a2cSIra W. Snyder */ 168230ec5a2cSIra W. Snyder if (chip->state == FL_READY && chip_ready(map, adr)) 168330ec5a2cSIra W. Snyder return 0; 168430ec5a2cSIra W. Snyder 168530ec5a2cSIra W. Snyder /* 168630ec5a2cSIra W. Snyder * Try several times to reset the chip and then wait for it 168730ec5a2cSIra W. Snyder * to become idle. The upper limit of a few milliseconds of 168830ec5a2cSIra W. Snyder * delay isn't a big problem: the kernel is dying anyway. It 168930ec5a2cSIra W. Snyder * is more important to save the messages. 169030ec5a2cSIra W. Snyder */ 169130ec5a2cSIra W. Snyder while (retries > 0) { 169230ec5a2cSIra W. Snyder const unsigned long timeo = (HZ / 1000) + 1; 169330ec5a2cSIra W. Snyder 169430ec5a2cSIra W. Snyder /* send the reset command */ 169530ec5a2cSIra W. Snyder map_write(map, CMD(0xF0), chip->start); 169630ec5a2cSIra W. Snyder 169730ec5a2cSIra W. Snyder /* wait for the chip to become ready */ 169830ec5a2cSIra W. Snyder for (i = 0; i < jiffies_to_usecs(timeo); i++) { 169930ec5a2cSIra W. Snyder if (chip_ready(map, adr)) 170030ec5a2cSIra W. Snyder return 0; 170130ec5a2cSIra W. Snyder 170230ec5a2cSIra W. Snyder udelay(1); 170330ec5a2cSIra W. Snyder } 170430ec5a2cSIra W. Snyder } 170530ec5a2cSIra W. Snyder 170630ec5a2cSIra W. Snyder /* the chip never became ready */ 170730ec5a2cSIra W. Snyder return -EBUSY; 170830ec5a2cSIra W. Snyder } 170930ec5a2cSIra W. Snyder 171030ec5a2cSIra W. Snyder /* 171130ec5a2cSIra W. Snyder * Write out one word of data to a single flash chip during a kernel panic 171230ec5a2cSIra W. Snyder * 171330ec5a2cSIra W. Snyder * This is only called during the panic_write() path. When panic_write() 171430ec5a2cSIra W. Snyder * is called, the kernel is in the process of a panic, and will soon be 171530ec5a2cSIra W. Snyder * dead. Therefore we don't take any locks, and attempt to get access 171630ec5a2cSIra W. Snyder * to the chip as soon as possible. 171730ec5a2cSIra W. Snyder * 171830ec5a2cSIra W. Snyder * The implementation of this routine is intentionally similar to 171930ec5a2cSIra W. Snyder * do_write_oneword(), in order to ease code maintenance. 172030ec5a2cSIra W. Snyder */ 172130ec5a2cSIra W. Snyder static int do_panic_write_oneword(struct map_info *map, struct flchip *chip, 172230ec5a2cSIra W. Snyder unsigned long adr, map_word datum) 172330ec5a2cSIra W. Snyder { 172430ec5a2cSIra W. Snyder const unsigned long uWriteTimeout = (HZ / 1000) + 1; 172530ec5a2cSIra W. Snyder struct cfi_private *cfi = map->fldrv_priv; 172630ec5a2cSIra W. Snyder int retry_cnt = 0; 172730ec5a2cSIra W. Snyder map_word oldd; 172830ec5a2cSIra W. Snyder int ret = 0; 172930ec5a2cSIra W. Snyder int i; 173030ec5a2cSIra W. Snyder 173130ec5a2cSIra W. Snyder adr += chip->start; 173230ec5a2cSIra W. Snyder 173330ec5a2cSIra W. Snyder ret = cfi_amdstd_panic_wait(map, chip, adr); 173430ec5a2cSIra W. Snyder if (ret) 173530ec5a2cSIra W. Snyder return ret; 173630ec5a2cSIra W. Snyder 173730ec5a2cSIra W. Snyder pr_debug("MTD %s(): PANIC WRITE 0x%.8lx(0x%.8lx)\n", 173830ec5a2cSIra W. Snyder __func__, adr, datum.x[0]); 173930ec5a2cSIra W. Snyder 174030ec5a2cSIra W. Snyder /* 174130ec5a2cSIra W. Snyder * Check for a NOP for the case when the datum to write is already 174230ec5a2cSIra W. Snyder * present - it saves time and works around buggy chips that corrupt 174330ec5a2cSIra W. Snyder * data at other locations when 0xff is written to a location that 174430ec5a2cSIra W. Snyder * already contains 0xff. 174530ec5a2cSIra W. Snyder */ 174630ec5a2cSIra W. Snyder oldd = map_read(map, adr); 174730ec5a2cSIra W. Snyder if (map_word_equal(map, oldd, datum)) { 174830ec5a2cSIra W. Snyder pr_debug("MTD %s(): NOP\n", __func__); 174930ec5a2cSIra W. Snyder goto op_done; 175030ec5a2cSIra W. Snyder } 175130ec5a2cSIra W. Snyder 175230ec5a2cSIra W. Snyder ENABLE_VPP(map); 175330ec5a2cSIra W. Snyder 175430ec5a2cSIra W. Snyder retry: 175530ec5a2cSIra W. Snyder cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 175630ec5a2cSIra W. Snyder cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 175730ec5a2cSIra W. Snyder cfi_send_gen_cmd(0xA0, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 175830ec5a2cSIra W. Snyder map_write(map, datum, adr); 175930ec5a2cSIra W. Snyder 176030ec5a2cSIra W. Snyder for (i = 0; i < jiffies_to_usecs(uWriteTimeout); i++) { 176130ec5a2cSIra W. Snyder if (chip_ready(map, adr)) 176230ec5a2cSIra W. Snyder break; 176330ec5a2cSIra W. Snyder 176430ec5a2cSIra W. Snyder udelay(1); 176530ec5a2cSIra W. Snyder } 176630ec5a2cSIra W. Snyder 176730ec5a2cSIra W. Snyder if (!chip_good(map, adr, datum)) { 176830ec5a2cSIra W. Snyder /* reset on all failures. */ 176930ec5a2cSIra W. Snyder map_write(map, CMD(0xF0), chip->start); 177030ec5a2cSIra W. Snyder /* FIXME - should have reset delay before continuing */ 177130ec5a2cSIra W. Snyder 177230ec5a2cSIra W. Snyder if (++retry_cnt <= MAX_WORD_RETRIES) 177330ec5a2cSIra W. Snyder goto retry; 177430ec5a2cSIra W. Snyder 177530ec5a2cSIra W. Snyder ret = -EIO; 177630ec5a2cSIra W. Snyder } 177730ec5a2cSIra W. Snyder 177830ec5a2cSIra W. Snyder op_done: 177930ec5a2cSIra W. Snyder DISABLE_VPP(map); 178030ec5a2cSIra W. Snyder return ret; 178130ec5a2cSIra W. Snyder } 178230ec5a2cSIra W. Snyder 178330ec5a2cSIra W. Snyder /* 178430ec5a2cSIra W. Snyder * Write out some data during a kernel panic 178530ec5a2cSIra W. Snyder * 178630ec5a2cSIra W. Snyder * This is used by the mtdoops driver to save the dying messages from a 178730ec5a2cSIra W. Snyder * kernel which has panic'd. 178830ec5a2cSIra W. Snyder * 178930ec5a2cSIra W. Snyder * This routine ignores all of the locking used throughout the rest of the 179030ec5a2cSIra W. Snyder * driver, in order to ensure that the data gets written out no matter what 179130ec5a2cSIra W. Snyder * state this driver (and the flash chip itself) was in when the kernel crashed. 179230ec5a2cSIra W. Snyder * 179330ec5a2cSIra W. Snyder * The implementation of this routine is intentionally similar to 179430ec5a2cSIra W. Snyder * cfi_amdstd_write_words(), in order to ease code maintenance. 179530ec5a2cSIra W. Snyder */ 179630ec5a2cSIra W. Snyder static int cfi_amdstd_panic_write(struct mtd_info *mtd, loff_t to, size_t len, 179730ec5a2cSIra W. Snyder size_t *retlen, const u_char *buf) 179830ec5a2cSIra W. Snyder { 179930ec5a2cSIra W. Snyder struct map_info *map = mtd->priv; 180030ec5a2cSIra W. Snyder struct cfi_private *cfi = map->fldrv_priv; 180130ec5a2cSIra W. Snyder unsigned long ofs, chipstart; 180230ec5a2cSIra W. Snyder int ret = 0; 180330ec5a2cSIra W. Snyder int chipnum; 180430ec5a2cSIra W. Snyder 180530ec5a2cSIra W. Snyder chipnum = to >> cfi->chipshift; 180630ec5a2cSIra W. Snyder ofs = to - (chipnum << cfi->chipshift); 180730ec5a2cSIra W. Snyder chipstart = cfi->chips[chipnum].start; 180830ec5a2cSIra W. Snyder 180930ec5a2cSIra W. Snyder /* If it's not bus aligned, do the first byte write */ 181030ec5a2cSIra W. Snyder if (ofs & (map_bankwidth(map) - 1)) { 181130ec5a2cSIra W. Snyder unsigned long bus_ofs = ofs & ~(map_bankwidth(map) - 1); 181230ec5a2cSIra W. Snyder int i = ofs - bus_ofs; 181330ec5a2cSIra W. Snyder int n = 0; 181430ec5a2cSIra W. Snyder map_word tmp_buf; 181530ec5a2cSIra W. Snyder 181630ec5a2cSIra W. Snyder ret = cfi_amdstd_panic_wait(map, &cfi->chips[chipnum], bus_ofs); 181730ec5a2cSIra W. Snyder if (ret) 181830ec5a2cSIra W. Snyder return ret; 181930ec5a2cSIra W. Snyder 182030ec5a2cSIra W. Snyder /* Load 'tmp_buf' with old contents of flash */ 182130ec5a2cSIra W. Snyder tmp_buf = map_read(map, bus_ofs + chipstart); 182230ec5a2cSIra W. Snyder 182330ec5a2cSIra W. Snyder /* Number of bytes to copy from buffer */ 182430ec5a2cSIra W. Snyder n = min_t(int, len, map_bankwidth(map) - i); 182530ec5a2cSIra W. Snyder 182630ec5a2cSIra W. Snyder tmp_buf = map_word_load_partial(map, tmp_buf, buf, i, n); 182730ec5a2cSIra W. Snyder 182830ec5a2cSIra W. Snyder ret = do_panic_write_oneword(map, &cfi->chips[chipnum], 182930ec5a2cSIra W. Snyder bus_ofs, tmp_buf); 183030ec5a2cSIra W. Snyder if (ret) 183130ec5a2cSIra W. Snyder return ret; 183230ec5a2cSIra W. Snyder 183330ec5a2cSIra W. Snyder ofs += n; 183430ec5a2cSIra W. Snyder buf += n; 183530ec5a2cSIra W. Snyder (*retlen) += n; 183630ec5a2cSIra W. Snyder len -= n; 183730ec5a2cSIra W. Snyder 183830ec5a2cSIra W. Snyder if (ofs >> cfi->chipshift) { 183930ec5a2cSIra W. Snyder chipnum++; 184030ec5a2cSIra W. Snyder ofs = 0; 184130ec5a2cSIra W. Snyder if (chipnum == cfi->numchips) 184230ec5a2cSIra W. Snyder return 0; 184330ec5a2cSIra W. Snyder } 184430ec5a2cSIra W. Snyder } 184530ec5a2cSIra W. Snyder 184630ec5a2cSIra W. Snyder /* We are now aligned, write as much as possible */ 184730ec5a2cSIra W. Snyder while (len >= map_bankwidth(map)) { 184830ec5a2cSIra W. Snyder map_word datum; 184930ec5a2cSIra W. Snyder 185030ec5a2cSIra W. Snyder datum = map_word_load(map, buf); 185130ec5a2cSIra W. Snyder 185230ec5a2cSIra W. Snyder ret = do_panic_write_oneword(map, &cfi->chips[chipnum], 185330ec5a2cSIra W. Snyder ofs, datum); 185430ec5a2cSIra W. Snyder if (ret) 185530ec5a2cSIra W. Snyder return ret; 185630ec5a2cSIra W. Snyder 185730ec5a2cSIra W. Snyder ofs += map_bankwidth(map); 185830ec5a2cSIra W. Snyder buf += map_bankwidth(map); 185930ec5a2cSIra W. Snyder (*retlen) += map_bankwidth(map); 186030ec5a2cSIra W. Snyder len -= map_bankwidth(map); 186130ec5a2cSIra W. Snyder 186230ec5a2cSIra W. Snyder if (ofs >> cfi->chipshift) { 186330ec5a2cSIra W. Snyder chipnum++; 186430ec5a2cSIra W. Snyder ofs = 0; 186530ec5a2cSIra W. Snyder if (chipnum == cfi->numchips) 186630ec5a2cSIra W. Snyder return 0; 186730ec5a2cSIra W. Snyder 186830ec5a2cSIra W. Snyder chipstart = cfi->chips[chipnum].start; 186930ec5a2cSIra W. Snyder } 187030ec5a2cSIra W. Snyder } 187130ec5a2cSIra W. Snyder 187230ec5a2cSIra W. Snyder /* Write the trailing bytes if any */ 187330ec5a2cSIra W. Snyder if (len & (map_bankwidth(map) - 1)) { 187430ec5a2cSIra W. Snyder map_word tmp_buf; 187530ec5a2cSIra W. Snyder 187630ec5a2cSIra W. Snyder ret = cfi_amdstd_panic_wait(map, &cfi->chips[chipnum], ofs); 187730ec5a2cSIra W. Snyder if (ret) 187830ec5a2cSIra W. Snyder return ret; 187930ec5a2cSIra W. Snyder 188030ec5a2cSIra W. Snyder tmp_buf = map_read(map, ofs + chipstart); 188130ec5a2cSIra W. Snyder 188230ec5a2cSIra W. Snyder tmp_buf = map_word_load_partial(map, tmp_buf, buf, 0, len); 188330ec5a2cSIra W. Snyder 188430ec5a2cSIra W. Snyder ret = do_panic_write_oneword(map, &cfi->chips[chipnum], 188530ec5a2cSIra W. Snyder ofs, tmp_buf); 188630ec5a2cSIra W. Snyder if (ret) 188730ec5a2cSIra W. Snyder return ret; 188830ec5a2cSIra W. Snyder 188930ec5a2cSIra W. Snyder (*retlen) += len; 189030ec5a2cSIra W. Snyder } 189130ec5a2cSIra W. Snyder 189230ec5a2cSIra W. Snyder return 0; 189330ec5a2cSIra W. Snyder } 189430ec5a2cSIra W. Snyder 18951da177e4SLinus Torvalds 18961da177e4SLinus Torvalds /* 18971da177e4SLinus Torvalds * Handle devices with one erase region, that only implement 18981da177e4SLinus Torvalds * the chip erase command. 18991da177e4SLinus Torvalds */ 190002b15e34STodd Poynor static int __xipram do_erase_chip(struct map_info *map, struct flchip *chip) 19011da177e4SLinus Torvalds { 19021da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 19031da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 19041da177e4SLinus Torvalds unsigned long int adr; 19051da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 19061da177e4SLinus Torvalds int ret = 0; 19071da177e4SLinus Torvalds 19081da177e4SLinus Torvalds adr = cfi->addr_unlock1; 19091da177e4SLinus Torvalds 1910c4e77376SStefani Seibold mutex_lock(&chip->mutex); 19111da177e4SLinus Torvalds ret = get_chip(map, chip, adr, FL_WRITING); 19121da177e4SLinus Torvalds if (ret) { 1913c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 19141da177e4SLinus Torvalds return ret; 19151da177e4SLinus Torvalds } 19161da177e4SLinus Torvalds 1917289c0522SBrian Norris pr_debug("MTD %s(): ERASE 0x%.8lx\n", 19181da177e4SLinus Torvalds __func__, chip->start ); 19191da177e4SLinus Torvalds 192002b15e34STodd Poynor XIP_INVAL_CACHED_RANGE(map, adr, map->size); 19211da177e4SLinus Torvalds ENABLE_VPP(map); 192202b15e34STodd Poynor xip_disable(map, chip, adr); 192302b15e34STodd Poynor 19241da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 19251da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 19261da177e4SLinus Torvalds cfi_send_gen_cmd(0x80, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 19271da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 19281da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 19291da177e4SLinus Torvalds cfi_send_gen_cmd(0x10, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 19301da177e4SLinus Torvalds 19311da177e4SLinus Torvalds chip->state = FL_ERASING; 19321da177e4SLinus Torvalds chip->erase_suspended = 0; 19331da177e4SLinus Torvalds chip->in_progress_block_addr = adr; 19341da177e4SLinus Torvalds 193502b15e34STodd Poynor INVALIDATE_CACHE_UDELAY(map, chip, 193602b15e34STodd Poynor adr, map->size, 193702b15e34STodd Poynor chip->erase_time*500); 19381da177e4SLinus Torvalds 19391da177e4SLinus Torvalds timeo = jiffies + (HZ*20); 19401da177e4SLinus Torvalds 19411da177e4SLinus Torvalds for (;;) { 19421da177e4SLinus Torvalds if (chip->state != FL_ERASING) { 19431da177e4SLinus Torvalds /* Someone's suspended the erase. Sleep */ 19441da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 19451da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 1946c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 19471da177e4SLinus Torvalds schedule(); 19481da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 1949c4e77376SStefani Seibold mutex_lock(&chip->mutex); 19501da177e4SLinus Torvalds continue; 19511da177e4SLinus Torvalds } 19521da177e4SLinus Torvalds if (chip->erase_suspended) { 19531da177e4SLinus Torvalds /* This erase was suspended and resumed. 19541da177e4SLinus Torvalds Adjust the timeout */ 19551da177e4SLinus Torvalds timeo = jiffies + (HZ*20); /* FIXME */ 19561da177e4SLinus Torvalds chip->erase_suspended = 0; 19571da177e4SLinus Torvalds } 19581da177e4SLinus Torvalds 19591da177e4SLinus Torvalds if (chip_ready(map, adr)) 19601da177e4SLinus Torvalds break; 19611da177e4SLinus Torvalds 1962fb4a90bfSEric W. Biedermann if (time_after(jiffies, timeo)) { 1963fb4a90bfSEric W. Biedermann printk(KERN_WARNING "MTD %s(): software timeout\n", 1964fb4a90bfSEric W. Biedermann __func__ ); 1965fb4a90bfSEric W. Biedermann break; 1966fb4a90bfSEric W. Biedermann } 1967fb4a90bfSEric W. Biedermann 19681da177e4SLinus Torvalds /* Latency issues. Drop the lock, wait a while and retry */ 196902b15e34STodd Poynor UDELAY(map, chip, adr, 1000000/HZ); 19701da177e4SLinus Torvalds } 1971fb4a90bfSEric W. Biedermann /* Did we succeed? */ 1972fb4a90bfSEric W. Biedermann if (!chip_good(map, adr, map_word_ff(map))) { 19731da177e4SLinus Torvalds /* reset on all failures. */ 19741da177e4SLinus Torvalds map_write( map, CMD(0xF0), chip->start ); 19751da177e4SLinus Torvalds /* FIXME - should have reset delay before continuing */ 19761da177e4SLinus Torvalds 19771da177e4SLinus Torvalds ret = -EIO; 1978fb4a90bfSEric W. Biedermann } 1979fb4a90bfSEric W. Biedermann 19801da177e4SLinus Torvalds chip->state = FL_READY; 198102b15e34STodd Poynor xip_enable(map, chip, adr); 1982e7d9377eSPaul Parsons DISABLE_VPP(map); 19831da177e4SLinus Torvalds put_chip(map, chip, adr); 1984c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 19851da177e4SLinus Torvalds 19861da177e4SLinus Torvalds return ret; 19871da177e4SLinus Torvalds } 19881da177e4SLinus Torvalds 19891da177e4SLinus Torvalds 199002b15e34STodd Poynor static int __xipram do_erase_oneblock(struct map_info *map, struct flchip *chip, unsigned long adr, int len, void *thunk) 19911da177e4SLinus Torvalds { 19921da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 19931da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 19941da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 19951da177e4SLinus Torvalds int ret = 0; 19961da177e4SLinus Torvalds 19971da177e4SLinus Torvalds adr += chip->start; 19981da177e4SLinus Torvalds 1999c4e77376SStefani Seibold mutex_lock(&chip->mutex); 20001da177e4SLinus Torvalds ret = get_chip(map, chip, adr, FL_ERASING); 20011da177e4SLinus Torvalds if (ret) { 2002c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 20031da177e4SLinus Torvalds return ret; 20041da177e4SLinus Torvalds } 20051da177e4SLinus Torvalds 2006289c0522SBrian Norris pr_debug("MTD %s(): ERASE 0x%.8lx\n", 20071da177e4SLinus Torvalds __func__, adr ); 20081da177e4SLinus Torvalds 200902b15e34STodd Poynor XIP_INVAL_CACHED_RANGE(map, adr, len); 20101da177e4SLinus Torvalds ENABLE_VPP(map); 201102b15e34STodd Poynor xip_disable(map, chip, adr); 201202b15e34STodd Poynor 20131da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 20141da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 20151da177e4SLinus Torvalds cfi_send_gen_cmd(0x80, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 20161da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 20171da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 201808968041SGuillaume LECERF map_write(map, cfi->sector_erase_cmd, adr); 20191da177e4SLinus Torvalds 20201da177e4SLinus Torvalds chip->state = FL_ERASING; 20211da177e4SLinus Torvalds chip->erase_suspended = 0; 20221da177e4SLinus Torvalds chip->in_progress_block_addr = adr; 20231da177e4SLinus Torvalds 202402b15e34STodd Poynor INVALIDATE_CACHE_UDELAY(map, chip, 202502b15e34STodd Poynor adr, len, 202602b15e34STodd Poynor chip->erase_time*500); 20271da177e4SLinus Torvalds 20281da177e4SLinus Torvalds timeo = jiffies + (HZ*20); 20291da177e4SLinus Torvalds 20301da177e4SLinus Torvalds for (;;) { 20311da177e4SLinus Torvalds if (chip->state != FL_ERASING) { 20321da177e4SLinus Torvalds /* Someone's suspended the erase. Sleep */ 20331da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 20341da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 2035c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 20361da177e4SLinus Torvalds schedule(); 20371da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 2038c4e77376SStefani Seibold mutex_lock(&chip->mutex); 20391da177e4SLinus Torvalds continue; 20401da177e4SLinus Torvalds } 20411da177e4SLinus Torvalds if (chip->erase_suspended) { 20421da177e4SLinus Torvalds /* This erase was suspended and resumed. 20431da177e4SLinus Torvalds Adjust the timeout */ 20441da177e4SLinus Torvalds timeo = jiffies + (HZ*20); /* FIXME */ 20451da177e4SLinus Torvalds chip->erase_suspended = 0; 20461da177e4SLinus Torvalds } 20471da177e4SLinus Torvalds 204802b15e34STodd Poynor if (chip_ready(map, adr)) { 204902b15e34STodd Poynor xip_enable(map, chip, adr); 20501da177e4SLinus Torvalds break; 205102b15e34STodd Poynor } 20521da177e4SLinus Torvalds 2053fb4a90bfSEric W. Biedermann if (time_after(jiffies, timeo)) { 205402b15e34STodd Poynor xip_enable(map, chip, adr); 2055fb4a90bfSEric W. Biedermann printk(KERN_WARNING "MTD %s(): software timeout\n", 2056fb4a90bfSEric W. Biedermann __func__ ); 2057fb4a90bfSEric W. Biedermann break; 2058fb4a90bfSEric W. Biedermann } 2059fb4a90bfSEric W. Biedermann 20601da177e4SLinus Torvalds /* Latency issues. Drop the lock, wait a while and retry */ 206102b15e34STodd Poynor UDELAY(map, chip, adr, 1000000/HZ); 20621da177e4SLinus Torvalds } 2063fb4a90bfSEric W. Biedermann /* Did we succeed? */ 206422fd9a87SThomas Gleixner if (!chip_good(map, adr, map_word_ff(map))) { 20651da177e4SLinus Torvalds /* reset on all failures. */ 20661da177e4SLinus Torvalds map_write( map, CMD(0xF0), chip->start ); 20671da177e4SLinus Torvalds /* FIXME - should have reset delay before continuing */ 20681da177e4SLinus Torvalds 20691da177e4SLinus Torvalds ret = -EIO; 2070fb4a90bfSEric W. Biedermann } 2071fb4a90bfSEric W. Biedermann 20721da177e4SLinus Torvalds chip->state = FL_READY; 2073e7d9377eSPaul Parsons DISABLE_VPP(map); 20741da177e4SLinus Torvalds put_chip(map, chip, adr); 2075c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 20761da177e4SLinus Torvalds return ret; 20771da177e4SLinus Torvalds } 20781da177e4SLinus Torvalds 20791da177e4SLinus Torvalds 2080ce0f33adSBen Dooks static int cfi_amdstd_erase_varsize(struct mtd_info *mtd, struct erase_info *instr) 20811da177e4SLinus Torvalds { 20821da177e4SLinus Torvalds unsigned long ofs, len; 20831da177e4SLinus Torvalds int ret; 20841da177e4SLinus Torvalds 20851da177e4SLinus Torvalds ofs = instr->addr; 20861da177e4SLinus Torvalds len = instr->len; 20871da177e4SLinus Torvalds 20881da177e4SLinus Torvalds ret = cfi_varsize_frob(mtd, do_erase_oneblock, ofs, len, NULL); 20891da177e4SLinus Torvalds if (ret) 20901da177e4SLinus Torvalds return ret; 20911da177e4SLinus Torvalds 20921da177e4SLinus Torvalds instr->state = MTD_ERASE_DONE; 20931da177e4SLinus Torvalds mtd_erase_callback(instr); 20941da177e4SLinus Torvalds 20951da177e4SLinus Torvalds return 0; 20961da177e4SLinus Torvalds } 20971da177e4SLinus Torvalds 20981da177e4SLinus Torvalds 20991da177e4SLinus Torvalds static int cfi_amdstd_erase_chip(struct mtd_info *mtd, struct erase_info *instr) 21001da177e4SLinus Torvalds { 21011da177e4SLinus Torvalds struct map_info *map = mtd->priv; 21021da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 21031da177e4SLinus Torvalds int ret = 0; 21041da177e4SLinus Torvalds 21051da177e4SLinus Torvalds if (instr->addr != 0) 21061da177e4SLinus Torvalds return -EINVAL; 21071da177e4SLinus Torvalds 21081da177e4SLinus Torvalds if (instr->len != mtd->size) 21091da177e4SLinus Torvalds return -EINVAL; 21101da177e4SLinus Torvalds 21111da177e4SLinus Torvalds ret = do_erase_chip(map, &cfi->chips[0]); 21121da177e4SLinus Torvalds if (ret) 21131da177e4SLinus Torvalds return ret; 21141da177e4SLinus Torvalds 21151da177e4SLinus Torvalds instr->state = MTD_ERASE_DONE; 21161da177e4SLinus Torvalds mtd_erase_callback(instr); 21171da177e4SLinus Torvalds 21181da177e4SLinus Torvalds return 0; 21191da177e4SLinus Torvalds } 21201da177e4SLinus Torvalds 21210165508cSHaavard Skinnemoen static int do_atmel_lock(struct map_info *map, struct flchip *chip, 21220165508cSHaavard Skinnemoen unsigned long adr, int len, void *thunk) 21230165508cSHaavard Skinnemoen { 21240165508cSHaavard Skinnemoen struct cfi_private *cfi = map->fldrv_priv; 21250165508cSHaavard Skinnemoen int ret; 21260165508cSHaavard Skinnemoen 2127c4e77376SStefani Seibold mutex_lock(&chip->mutex); 21280165508cSHaavard Skinnemoen ret = get_chip(map, chip, adr + chip->start, FL_LOCKING); 21290165508cSHaavard Skinnemoen if (ret) 21300165508cSHaavard Skinnemoen goto out_unlock; 21310165508cSHaavard Skinnemoen chip->state = FL_LOCKING; 21320165508cSHaavard Skinnemoen 21330a32a102SBrian Norris pr_debug("MTD %s(): LOCK 0x%08lx len %d\n", __func__, adr, len); 21340165508cSHaavard Skinnemoen 21350165508cSHaavard Skinnemoen cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, 21360165508cSHaavard Skinnemoen cfi->device_type, NULL); 21370165508cSHaavard Skinnemoen cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, 21380165508cSHaavard Skinnemoen cfi->device_type, NULL); 21390165508cSHaavard Skinnemoen cfi_send_gen_cmd(0x80, cfi->addr_unlock1, chip->start, map, cfi, 21400165508cSHaavard Skinnemoen cfi->device_type, NULL); 21410165508cSHaavard Skinnemoen cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, 21420165508cSHaavard Skinnemoen cfi->device_type, NULL); 21430165508cSHaavard Skinnemoen cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, 21440165508cSHaavard Skinnemoen cfi->device_type, NULL); 21450165508cSHaavard Skinnemoen map_write(map, CMD(0x40), chip->start + adr); 21460165508cSHaavard Skinnemoen 21470165508cSHaavard Skinnemoen chip->state = FL_READY; 21480165508cSHaavard Skinnemoen put_chip(map, chip, adr + chip->start); 21490165508cSHaavard Skinnemoen ret = 0; 21500165508cSHaavard Skinnemoen 21510165508cSHaavard Skinnemoen out_unlock: 2152c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 21530165508cSHaavard Skinnemoen return ret; 21540165508cSHaavard Skinnemoen } 21550165508cSHaavard Skinnemoen 21560165508cSHaavard Skinnemoen static int do_atmel_unlock(struct map_info *map, struct flchip *chip, 21570165508cSHaavard Skinnemoen unsigned long adr, int len, void *thunk) 21580165508cSHaavard Skinnemoen { 21590165508cSHaavard Skinnemoen struct cfi_private *cfi = map->fldrv_priv; 21600165508cSHaavard Skinnemoen int ret; 21610165508cSHaavard Skinnemoen 2162c4e77376SStefani Seibold mutex_lock(&chip->mutex); 21630165508cSHaavard Skinnemoen ret = get_chip(map, chip, adr + chip->start, FL_UNLOCKING); 21640165508cSHaavard Skinnemoen if (ret) 21650165508cSHaavard Skinnemoen goto out_unlock; 21660165508cSHaavard Skinnemoen chip->state = FL_UNLOCKING; 21670165508cSHaavard Skinnemoen 21680a32a102SBrian Norris pr_debug("MTD %s(): LOCK 0x%08lx len %d\n", __func__, adr, len); 21690165508cSHaavard Skinnemoen 21700165508cSHaavard Skinnemoen cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, 21710165508cSHaavard Skinnemoen cfi->device_type, NULL); 21720165508cSHaavard Skinnemoen map_write(map, CMD(0x70), adr); 21730165508cSHaavard Skinnemoen 21740165508cSHaavard Skinnemoen chip->state = FL_READY; 21750165508cSHaavard Skinnemoen put_chip(map, chip, adr + chip->start); 21760165508cSHaavard Skinnemoen ret = 0; 21770165508cSHaavard Skinnemoen 21780165508cSHaavard Skinnemoen out_unlock: 2179c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 21800165508cSHaavard Skinnemoen return ret; 21810165508cSHaavard Skinnemoen } 21820165508cSHaavard Skinnemoen 218369423d99SAdrian Hunter static int cfi_atmel_lock(struct mtd_info *mtd, loff_t ofs, uint64_t len) 21840165508cSHaavard Skinnemoen { 21850165508cSHaavard Skinnemoen return cfi_varsize_frob(mtd, do_atmel_lock, ofs, len, NULL); 21860165508cSHaavard Skinnemoen } 21870165508cSHaavard Skinnemoen 218869423d99SAdrian Hunter static int cfi_atmel_unlock(struct mtd_info *mtd, loff_t ofs, uint64_t len) 21890165508cSHaavard Skinnemoen { 21900165508cSHaavard Skinnemoen return cfi_varsize_frob(mtd, do_atmel_unlock, ofs, len, NULL); 21910165508cSHaavard Skinnemoen } 21920165508cSHaavard Skinnemoen 21931648eaaaSStefan Roese /* 21941648eaaaSStefan Roese * Advanced Sector Protection - PPB (Persistent Protection Bit) locking 21951648eaaaSStefan Roese */ 21961648eaaaSStefan Roese 21971648eaaaSStefan Roese struct ppb_lock { 21981648eaaaSStefan Roese struct flchip *chip; 21991648eaaaSStefan Roese loff_t offset; 22001648eaaaSStefan Roese int locked; 22011648eaaaSStefan Roese }; 22021648eaaaSStefan Roese 22031648eaaaSStefan Roese #define MAX_SECTORS 512 22041648eaaaSStefan Roese 22051648eaaaSStefan Roese #define DO_XXLOCK_ONEBLOCK_LOCK ((void *)1) 22061648eaaaSStefan Roese #define DO_XXLOCK_ONEBLOCK_UNLOCK ((void *)2) 22071648eaaaSStefan Roese #define DO_XXLOCK_ONEBLOCK_GETLOCK ((void *)3) 22081648eaaaSStefan Roese 22091648eaaaSStefan Roese static int __maybe_unused do_ppb_xxlock(struct map_info *map, 22101648eaaaSStefan Roese struct flchip *chip, 22111648eaaaSStefan Roese unsigned long adr, int len, void *thunk) 22121648eaaaSStefan Roese { 22131648eaaaSStefan Roese struct cfi_private *cfi = map->fldrv_priv; 22141648eaaaSStefan Roese unsigned long timeo; 22151648eaaaSStefan Roese int ret; 22161648eaaaSStefan Roese 22171648eaaaSStefan Roese mutex_lock(&chip->mutex); 22181648eaaaSStefan Roese ret = get_chip(map, chip, adr + chip->start, FL_LOCKING); 22191648eaaaSStefan Roese if (ret) { 22201648eaaaSStefan Roese mutex_unlock(&chip->mutex); 22211648eaaaSStefan Roese return ret; 22221648eaaaSStefan Roese } 22231648eaaaSStefan Roese 22241648eaaaSStefan Roese pr_debug("MTD %s(): XXLOCK 0x%08lx len %d\n", __func__, adr, len); 22251648eaaaSStefan Roese 22261648eaaaSStefan Roese cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, 22271648eaaaSStefan Roese cfi->device_type, NULL); 22281648eaaaSStefan Roese cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, 22291648eaaaSStefan Roese cfi->device_type, NULL); 22301648eaaaSStefan Roese /* PPB entry command */ 22311648eaaaSStefan Roese cfi_send_gen_cmd(0xC0, cfi->addr_unlock1, chip->start, map, cfi, 22321648eaaaSStefan Roese cfi->device_type, NULL); 22331648eaaaSStefan Roese 22341648eaaaSStefan Roese if (thunk == DO_XXLOCK_ONEBLOCK_LOCK) { 22351648eaaaSStefan Roese chip->state = FL_LOCKING; 22361648eaaaSStefan Roese map_write(map, CMD(0xA0), chip->start + adr); 22371648eaaaSStefan Roese map_write(map, CMD(0x00), chip->start + adr); 22381648eaaaSStefan Roese } else if (thunk == DO_XXLOCK_ONEBLOCK_UNLOCK) { 22391648eaaaSStefan Roese /* 22401648eaaaSStefan Roese * Unlocking of one specific sector is not supported, so we 22411648eaaaSStefan Roese * have to unlock all sectors of this device instead 22421648eaaaSStefan Roese */ 22431648eaaaSStefan Roese chip->state = FL_UNLOCKING; 22441648eaaaSStefan Roese map_write(map, CMD(0x80), chip->start); 22451648eaaaSStefan Roese map_write(map, CMD(0x30), chip->start); 22461648eaaaSStefan Roese } else if (thunk == DO_XXLOCK_ONEBLOCK_GETLOCK) { 22471648eaaaSStefan Roese chip->state = FL_JEDEC_QUERY; 22481648eaaaSStefan Roese /* Return locked status: 0->locked, 1->unlocked */ 22491648eaaaSStefan Roese ret = !cfi_read_query(map, adr); 22501648eaaaSStefan Roese } else 22511648eaaaSStefan Roese BUG(); 22521648eaaaSStefan Roese 22531648eaaaSStefan Roese /* 22541648eaaaSStefan Roese * Wait for some time as unlocking of all sectors takes quite long 22551648eaaaSStefan Roese */ 22561648eaaaSStefan Roese timeo = jiffies + msecs_to_jiffies(2000); /* 2s max (un)locking */ 22571648eaaaSStefan Roese for (;;) { 22581648eaaaSStefan Roese if (chip_ready(map, adr)) 22591648eaaaSStefan Roese break; 22601648eaaaSStefan Roese 22611648eaaaSStefan Roese if (time_after(jiffies, timeo)) { 22621648eaaaSStefan Roese printk(KERN_ERR "Waiting for chip to be ready timed out.\n"); 22631648eaaaSStefan Roese ret = -EIO; 22641648eaaaSStefan Roese break; 22651648eaaaSStefan Roese } 22661648eaaaSStefan Roese 22671648eaaaSStefan Roese UDELAY(map, chip, adr, 1); 22681648eaaaSStefan Roese } 22691648eaaaSStefan Roese 22701648eaaaSStefan Roese /* Exit BC commands */ 22711648eaaaSStefan Roese map_write(map, CMD(0x90), chip->start); 22721648eaaaSStefan Roese map_write(map, CMD(0x00), chip->start); 22731648eaaaSStefan Roese 22741648eaaaSStefan Roese chip->state = FL_READY; 22751648eaaaSStefan Roese put_chip(map, chip, adr + chip->start); 22761648eaaaSStefan Roese mutex_unlock(&chip->mutex); 22771648eaaaSStefan Roese 22781648eaaaSStefan Roese return ret; 22791648eaaaSStefan Roese } 22801648eaaaSStefan Roese 22811648eaaaSStefan Roese static int __maybe_unused cfi_ppb_lock(struct mtd_info *mtd, loff_t ofs, 22821648eaaaSStefan Roese uint64_t len) 22831648eaaaSStefan Roese { 22841648eaaaSStefan Roese return cfi_varsize_frob(mtd, do_ppb_xxlock, ofs, len, 22851648eaaaSStefan Roese DO_XXLOCK_ONEBLOCK_LOCK); 22861648eaaaSStefan Roese } 22871648eaaaSStefan Roese 22881648eaaaSStefan Roese static int __maybe_unused cfi_ppb_unlock(struct mtd_info *mtd, loff_t ofs, 22891648eaaaSStefan Roese uint64_t len) 22901648eaaaSStefan Roese { 22911648eaaaSStefan Roese struct mtd_erase_region_info *regions = mtd->eraseregions; 22921648eaaaSStefan Roese struct map_info *map = mtd->priv; 22931648eaaaSStefan Roese struct cfi_private *cfi = map->fldrv_priv; 22941648eaaaSStefan Roese struct ppb_lock *sect; 22951648eaaaSStefan Roese unsigned long adr; 22961648eaaaSStefan Roese loff_t offset; 22971648eaaaSStefan Roese uint64_t length; 22981648eaaaSStefan Roese int chipnum; 22991648eaaaSStefan Roese int i; 23001648eaaaSStefan Roese int sectors; 23011648eaaaSStefan Roese int ret; 23021648eaaaSStefan Roese 23031648eaaaSStefan Roese /* 23041648eaaaSStefan Roese * PPB unlocking always unlocks all sectors of the flash chip. 23051648eaaaSStefan Roese * We need to re-lock all previously locked sectors. So lets 23061648eaaaSStefan Roese * first check the locking status of all sectors and save 23071648eaaaSStefan Roese * it for future use. 23081648eaaaSStefan Roese */ 23091648eaaaSStefan Roese sect = kzalloc(MAX_SECTORS * sizeof(struct ppb_lock), GFP_KERNEL); 23101648eaaaSStefan Roese if (!sect) 23111648eaaaSStefan Roese return -ENOMEM; 23121648eaaaSStefan Roese 23131648eaaaSStefan Roese /* 23141648eaaaSStefan Roese * This code to walk all sectors is a slightly modified version 23151648eaaaSStefan Roese * of the cfi_varsize_frob() code. 23161648eaaaSStefan Roese */ 23171648eaaaSStefan Roese i = 0; 23181648eaaaSStefan Roese chipnum = 0; 23191648eaaaSStefan Roese adr = 0; 23201648eaaaSStefan Roese sectors = 0; 23211648eaaaSStefan Roese offset = 0; 23221648eaaaSStefan Roese length = mtd->size; 23231648eaaaSStefan Roese 23241648eaaaSStefan Roese while (length) { 23251648eaaaSStefan Roese int size = regions[i].erasesize; 23261648eaaaSStefan Roese 23271648eaaaSStefan Roese /* 23281648eaaaSStefan Roese * Only test sectors that shall not be unlocked. The other 23291648eaaaSStefan Roese * sectors shall be unlocked, so lets keep their locking 23301648eaaaSStefan Roese * status at "unlocked" (locked=0) for the final re-locking. 23311648eaaaSStefan Roese */ 23321648eaaaSStefan Roese if ((adr < ofs) || (adr >= (ofs + len))) { 23331648eaaaSStefan Roese sect[sectors].chip = &cfi->chips[chipnum]; 23341648eaaaSStefan Roese sect[sectors].offset = offset; 23351648eaaaSStefan Roese sect[sectors].locked = do_ppb_xxlock( 23361648eaaaSStefan Roese map, &cfi->chips[chipnum], adr, 0, 23371648eaaaSStefan Roese DO_XXLOCK_ONEBLOCK_GETLOCK); 23381648eaaaSStefan Roese } 23391648eaaaSStefan Roese 23401648eaaaSStefan Roese adr += size; 23411648eaaaSStefan Roese offset += size; 23421648eaaaSStefan Roese length -= size; 23431648eaaaSStefan Roese 23441648eaaaSStefan Roese if (offset == regions[i].offset + size * regions[i].numblocks) 23451648eaaaSStefan Roese i++; 23461648eaaaSStefan Roese 23471648eaaaSStefan Roese if (adr >> cfi->chipshift) { 23481648eaaaSStefan Roese adr = 0; 23491648eaaaSStefan Roese chipnum++; 23501648eaaaSStefan Roese 23511648eaaaSStefan Roese if (chipnum >= cfi->numchips) 23521648eaaaSStefan Roese break; 23531648eaaaSStefan Roese } 23541648eaaaSStefan Roese 23551648eaaaSStefan Roese sectors++; 23561648eaaaSStefan Roese if (sectors >= MAX_SECTORS) { 23571648eaaaSStefan Roese printk(KERN_ERR "Only %d sectors for PPB locking supported!\n", 23581648eaaaSStefan Roese MAX_SECTORS); 23591648eaaaSStefan Roese kfree(sect); 23601648eaaaSStefan Roese return -EINVAL; 23611648eaaaSStefan Roese } 23621648eaaaSStefan Roese } 23631648eaaaSStefan Roese 23641648eaaaSStefan Roese /* Now unlock the whole chip */ 23651648eaaaSStefan Roese ret = cfi_varsize_frob(mtd, do_ppb_xxlock, ofs, len, 23661648eaaaSStefan Roese DO_XXLOCK_ONEBLOCK_UNLOCK); 23671648eaaaSStefan Roese if (ret) { 23681648eaaaSStefan Roese kfree(sect); 23691648eaaaSStefan Roese return ret; 23701648eaaaSStefan Roese } 23711648eaaaSStefan Roese 23721648eaaaSStefan Roese /* 23731648eaaaSStefan Roese * PPB unlocking always unlocks all sectors of the flash chip. 23741648eaaaSStefan Roese * We need to re-lock all previously locked sectors. 23751648eaaaSStefan Roese */ 23761648eaaaSStefan Roese for (i = 0; i < sectors; i++) { 23771648eaaaSStefan Roese if (sect[i].locked) 23781648eaaaSStefan Roese do_ppb_xxlock(map, sect[i].chip, sect[i].offset, 0, 23791648eaaaSStefan Roese DO_XXLOCK_ONEBLOCK_LOCK); 23801648eaaaSStefan Roese } 23811648eaaaSStefan Roese 23821648eaaaSStefan Roese kfree(sect); 23831648eaaaSStefan Roese return ret; 23841648eaaaSStefan Roese } 23851648eaaaSStefan Roese 23861648eaaaSStefan Roese static int __maybe_unused cfi_ppb_is_locked(struct mtd_info *mtd, loff_t ofs, 23871648eaaaSStefan Roese uint64_t len) 23881648eaaaSStefan Roese { 23891648eaaaSStefan Roese return cfi_varsize_frob(mtd, do_ppb_xxlock, ofs, len, 23901648eaaaSStefan Roese DO_XXLOCK_ONEBLOCK_GETLOCK) ? 1 : 0; 23911648eaaaSStefan Roese } 23921da177e4SLinus Torvalds 23931da177e4SLinus Torvalds static void cfi_amdstd_sync (struct mtd_info *mtd) 23941da177e4SLinus Torvalds { 23951da177e4SLinus Torvalds struct map_info *map = mtd->priv; 23961da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 23971da177e4SLinus Torvalds int i; 23981da177e4SLinus Torvalds struct flchip *chip; 23991da177e4SLinus Torvalds int ret = 0; 24001da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 24011da177e4SLinus Torvalds 24021da177e4SLinus Torvalds for (i=0; !ret && i<cfi->numchips; i++) { 24031da177e4SLinus Torvalds chip = &cfi->chips[i]; 24041da177e4SLinus Torvalds 24051da177e4SLinus Torvalds retry: 2406c4e77376SStefani Seibold mutex_lock(&chip->mutex); 24071da177e4SLinus Torvalds 24081da177e4SLinus Torvalds switch(chip->state) { 24091da177e4SLinus Torvalds case FL_READY: 24101da177e4SLinus Torvalds case FL_STATUS: 24111da177e4SLinus Torvalds case FL_CFI_QUERY: 24121da177e4SLinus Torvalds case FL_JEDEC_QUERY: 24131da177e4SLinus Torvalds chip->oldstate = chip->state; 24141da177e4SLinus Torvalds chip->state = FL_SYNCING; 24151da177e4SLinus Torvalds /* No need to wake_up() on this state change - 24161da177e4SLinus Torvalds * as the whole point is that nobody can do anything 24171da177e4SLinus Torvalds * with the chip now anyway. 24181da177e4SLinus Torvalds */ 24191da177e4SLinus Torvalds case FL_SYNCING: 2420c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 24211da177e4SLinus Torvalds break; 24221da177e4SLinus Torvalds 24231da177e4SLinus Torvalds default: 24241da177e4SLinus Torvalds /* Not an idle state */ 2425f8e30e44SDmitry Adamushko set_current_state(TASK_UNINTERRUPTIBLE); 24261da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 24271da177e4SLinus Torvalds 2428c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 24291da177e4SLinus Torvalds 24301da177e4SLinus Torvalds schedule(); 24311da177e4SLinus Torvalds 24321da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 24331da177e4SLinus Torvalds 24341da177e4SLinus Torvalds goto retry; 24351da177e4SLinus Torvalds } 24361da177e4SLinus Torvalds } 24371da177e4SLinus Torvalds 24381da177e4SLinus Torvalds /* Unlock the chips again */ 24391da177e4SLinus Torvalds 24401da177e4SLinus Torvalds for (i--; i >=0; i--) { 24411da177e4SLinus Torvalds chip = &cfi->chips[i]; 24421da177e4SLinus Torvalds 2443c4e77376SStefani Seibold mutex_lock(&chip->mutex); 24441da177e4SLinus Torvalds 24451da177e4SLinus Torvalds if (chip->state == FL_SYNCING) { 24461da177e4SLinus Torvalds chip->state = chip->oldstate; 24471da177e4SLinus Torvalds wake_up(&chip->wq); 24481da177e4SLinus Torvalds } 2449c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 24501da177e4SLinus Torvalds } 24511da177e4SLinus Torvalds } 24521da177e4SLinus Torvalds 24531da177e4SLinus Torvalds 24541da177e4SLinus Torvalds static int cfi_amdstd_suspend(struct mtd_info *mtd) 24551da177e4SLinus Torvalds { 24561da177e4SLinus Torvalds struct map_info *map = mtd->priv; 24571da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 24581da177e4SLinus Torvalds int i; 24591da177e4SLinus Torvalds struct flchip *chip; 24601da177e4SLinus Torvalds int ret = 0; 24611da177e4SLinus Torvalds 24621da177e4SLinus Torvalds for (i=0; !ret && i<cfi->numchips; i++) { 24631da177e4SLinus Torvalds chip = &cfi->chips[i]; 24641da177e4SLinus Torvalds 2465c4e77376SStefani Seibold mutex_lock(&chip->mutex); 24661da177e4SLinus Torvalds 24671da177e4SLinus Torvalds switch(chip->state) { 24681da177e4SLinus Torvalds case FL_READY: 24691da177e4SLinus Torvalds case FL_STATUS: 24701da177e4SLinus Torvalds case FL_CFI_QUERY: 24711da177e4SLinus Torvalds case FL_JEDEC_QUERY: 24721da177e4SLinus Torvalds chip->oldstate = chip->state; 24731da177e4SLinus Torvalds chip->state = FL_PM_SUSPENDED; 24741da177e4SLinus Torvalds /* No need to wake_up() on this state change - 24751da177e4SLinus Torvalds * as the whole point is that nobody can do anything 24761da177e4SLinus Torvalds * with the chip now anyway. 24771da177e4SLinus Torvalds */ 24781da177e4SLinus Torvalds case FL_PM_SUSPENDED: 24791da177e4SLinus Torvalds break; 24801da177e4SLinus Torvalds 24811da177e4SLinus Torvalds default: 24821da177e4SLinus Torvalds ret = -EAGAIN; 24831da177e4SLinus Torvalds break; 24841da177e4SLinus Torvalds } 2485c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 24861da177e4SLinus Torvalds } 24871da177e4SLinus Torvalds 24881da177e4SLinus Torvalds /* Unlock the chips again */ 24891da177e4SLinus Torvalds 24901da177e4SLinus Torvalds if (ret) { 24911da177e4SLinus Torvalds for (i--; i >=0; i--) { 24921da177e4SLinus Torvalds chip = &cfi->chips[i]; 24931da177e4SLinus Torvalds 2494c4e77376SStefani Seibold mutex_lock(&chip->mutex); 24951da177e4SLinus Torvalds 24961da177e4SLinus Torvalds if (chip->state == FL_PM_SUSPENDED) { 24971da177e4SLinus Torvalds chip->state = chip->oldstate; 24981da177e4SLinus Torvalds wake_up(&chip->wq); 24991da177e4SLinus Torvalds } 2500c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 25011da177e4SLinus Torvalds } 25021da177e4SLinus Torvalds } 25031da177e4SLinus Torvalds 25041da177e4SLinus Torvalds return ret; 25051da177e4SLinus Torvalds } 25061da177e4SLinus Torvalds 25071da177e4SLinus Torvalds 25081da177e4SLinus Torvalds static void cfi_amdstd_resume(struct mtd_info *mtd) 25091da177e4SLinus Torvalds { 25101da177e4SLinus Torvalds struct map_info *map = mtd->priv; 25111da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 25121da177e4SLinus Torvalds int i; 25131da177e4SLinus Torvalds struct flchip *chip; 25141da177e4SLinus Torvalds 25151da177e4SLinus Torvalds for (i=0; i<cfi->numchips; i++) { 25161da177e4SLinus Torvalds 25171da177e4SLinus Torvalds chip = &cfi->chips[i]; 25181da177e4SLinus Torvalds 2519c4e77376SStefani Seibold mutex_lock(&chip->mutex); 25201da177e4SLinus Torvalds 25211da177e4SLinus Torvalds if (chip->state == FL_PM_SUSPENDED) { 25221da177e4SLinus Torvalds chip->state = FL_READY; 25231da177e4SLinus Torvalds map_write(map, CMD(0xF0), chip->start); 25241da177e4SLinus Torvalds wake_up(&chip->wq); 25251da177e4SLinus Torvalds } 25261da177e4SLinus Torvalds else 25271da177e4SLinus Torvalds printk(KERN_ERR "Argh. Chip not in PM_SUSPENDED state upon resume()\n"); 25281da177e4SLinus Torvalds 2529c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 25301da177e4SLinus Torvalds } 25311da177e4SLinus Torvalds } 25321da177e4SLinus Torvalds 2533eafe1311SKevin Cernekee 2534eafe1311SKevin Cernekee /* 2535eafe1311SKevin Cernekee * Ensure that the flash device is put back into read array mode before 2536eafe1311SKevin Cernekee * unloading the driver or rebooting. On some systems, rebooting while 2537eafe1311SKevin Cernekee * the flash is in query/program/erase mode will prevent the CPU from 2538eafe1311SKevin Cernekee * fetching the bootloader code, requiring a hard reset or power cycle. 2539eafe1311SKevin Cernekee */ 2540eafe1311SKevin Cernekee static int cfi_amdstd_reset(struct mtd_info *mtd) 2541eafe1311SKevin Cernekee { 2542eafe1311SKevin Cernekee struct map_info *map = mtd->priv; 2543eafe1311SKevin Cernekee struct cfi_private *cfi = map->fldrv_priv; 2544eafe1311SKevin Cernekee int i, ret; 2545eafe1311SKevin Cernekee struct flchip *chip; 2546eafe1311SKevin Cernekee 2547eafe1311SKevin Cernekee for (i = 0; i < cfi->numchips; i++) { 2548eafe1311SKevin Cernekee 2549eafe1311SKevin Cernekee chip = &cfi->chips[i]; 2550eafe1311SKevin Cernekee 2551eafe1311SKevin Cernekee mutex_lock(&chip->mutex); 2552eafe1311SKevin Cernekee 2553eafe1311SKevin Cernekee ret = get_chip(map, chip, chip->start, FL_SHUTDOWN); 2554eafe1311SKevin Cernekee if (!ret) { 2555eafe1311SKevin Cernekee map_write(map, CMD(0xF0), chip->start); 2556eafe1311SKevin Cernekee chip->state = FL_SHUTDOWN; 2557eafe1311SKevin Cernekee put_chip(map, chip, chip->start); 2558eafe1311SKevin Cernekee } 2559eafe1311SKevin Cernekee 2560eafe1311SKevin Cernekee mutex_unlock(&chip->mutex); 2561eafe1311SKevin Cernekee } 2562eafe1311SKevin Cernekee 2563eafe1311SKevin Cernekee return 0; 2564eafe1311SKevin Cernekee } 2565eafe1311SKevin Cernekee 2566eafe1311SKevin Cernekee 2567eafe1311SKevin Cernekee static int cfi_amdstd_reboot(struct notifier_block *nb, unsigned long val, 2568eafe1311SKevin Cernekee void *v) 2569eafe1311SKevin Cernekee { 2570eafe1311SKevin Cernekee struct mtd_info *mtd; 2571eafe1311SKevin Cernekee 2572eafe1311SKevin Cernekee mtd = container_of(nb, struct mtd_info, reboot_notifier); 2573eafe1311SKevin Cernekee cfi_amdstd_reset(mtd); 2574eafe1311SKevin Cernekee return NOTIFY_DONE; 2575eafe1311SKevin Cernekee } 2576eafe1311SKevin Cernekee 2577eafe1311SKevin Cernekee 25781da177e4SLinus Torvalds static void cfi_amdstd_destroy(struct mtd_info *mtd) 25791da177e4SLinus Torvalds { 25801da177e4SLinus Torvalds struct map_info *map = mtd->priv; 25811da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 2582fa671646SJesper Juhl 2583eafe1311SKevin Cernekee cfi_amdstd_reset(mtd); 2584eafe1311SKevin Cernekee unregister_reboot_notifier(&mtd->reboot_notifier); 25851da177e4SLinus Torvalds kfree(cfi->cmdset_priv); 25861da177e4SLinus Torvalds kfree(cfi->cfiq); 25871da177e4SLinus Torvalds kfree(cfi); 25881da177e4SLinus Torvalds kfree(mtd->eraseregions); 25891da177e4SLinus Torvalds } 25901da177e4SLinus Torvalds 25911da177e4SLinus Torvalds MODULE_LICENSE("GPL"); 25921da177e4SLinus Torvalds MODULE_AUTHOR("Crossnet Co. <info@crossnet.co.jp> et al."); 25931da177e4SLinus Torvalds MODULE_DESCRIPTION("MTD chip driver for AMD/Fujitsu flash chips"); 259480461128SGuillaume LECERF MODULE_ALIAS("cfi_cmdset_0006"); 25951e804cecSDavid Woodhouse MODULE_ALIAS("cfi_cmdset_0701"); 2596