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> 361da177e4SLinus Torvalds #include <linux/mtd/compatmac.h> 371da177e4SLinus Torvalds #include <linux/mtd/map.h> 381da177e4SLinus Torvalds #include <linux/mtd/mtd.h> 391da177e4SLinus Torvalds #include <linux/mtd/cfi.h> 4002b15e34STodd Poynor #include <linux/mtd/xip.h> 411da177e4SLinus Torvalds 421da177e4SLinus Torvalds #define AMD_BOOTLOC_BUG 431da177e4SLinus Torvalds #define FORCE_WORD_WRITE 0 441da177e4SLinus Torvalds 451da177e4SLinus Torvalds #define MAX_WORD_RETRIES 3 461da177e4SLinus Torvalds 471da177e4SLinus Torvalds #define SST49LF004B 0x0060 4889072ef9SRyan Jackson #define SST49LF040B 0x0050 49fb4a90bfSEric W. Biedermann #define SST49LF008A 0x005a 500165508cSHaavard Skinnemoen #define AT49BV6416 0x00d6 511da177e4SLinus Torvalds 521da177e4SLinus Torvalds static int cfi_amdstd_read (struct mtd_info *, loff_t, size_t, size_t *, u_char *); 531da177e4SLinus Torvalds static int cfi_amdstd_write_words(struct mtd_info *, loff_t, size_t, size_t *, const u_char *); 541da177e4SLinus Torvalds static int cfi_amdstd_write_buffers(struct mtd_info *, loff_t, size_t, size_t *, const u_char *); 551da177e4SLinus Torvalds static int cfi_amdstd_erase_chip(struct mtd_info *, struct erase_info *); 561da177e4SLinus Torvalds static int cfi_amdstd_erase_varsize(struct mtd_info *, struct erase_info *); 571da177e4SLinus Torvalds static void cfi_amdstd_sync (struct mtd_info *); 581da177e4SLinus Torvalds static int cfi_amdstd_suspend (struct mtd_info *); 591da177e4SLinus Torvalds static void cfi_amdstd_resume (struct mtd_info *); 60eafe1311SKevin Cernekee static int cfi_amdstd_reboot(struct notifier_block *, unsigned long, void *); 611da177e4SLinus Torvalds static int cfi_amdstd_secsi_read (struct mtd_info *, loff_t, size_t, size_t *, u_char *); 621da177e4SLinus Torvalds 631da177e4SLinus Torvalds static void cfi_amdstd_destroy(struct mtd_info *); 641da177e4SLinus Torvalds 651da177e4SLinus Torvalds struct mtd_info *cfi_cmdset_0002(struct map_info *, int); 661da177e4SLinus Torvalds static struct mtd_info *cfi_amdstd_setup (struct mtd_info *); 671da177e4SLinus Torvalds 681da177e4SLinus Torvalds static int get_chip(struct map_info *map, struct flchip *chip, unsigned long adr, int mode); 691da177e4SLinus Torvalds static void put_chip(struct map_info *map, struct flchip *chip, unsigned long adr); 701da177e4SLinus Torvalds #include "fwh_lock.h" 711da177e4SLinus Torvalds 7269423d99SAdrian Hunter static int cfi_atmel_lock(struct mtd_info *mtd, loff_t ofs, uint64_t len); 7369423d99SAdrian Hunter static int cfi_atmel_unlock(struct mtd_info *mtd, loff_t ofs, uint64_t len); 740165508cSHaavard Skinnemoen 751da177e4SLinus Torvalds static struct mtd_chip_driver cfi_amdstd_chipdrv = { 761da177e4SLinus Torvalds .probe = NULL, /* Not usable directly */ 771da177e4SLinus Torvalds .destroy = cfi_amdstd_destroy, 781da177e4SLinus Torvalds .name = "cfi_cmdset_0002", 791da177e4SLinus Torvalds .module = THIS_MODULE 801da177e4SLinus Torvalds }; 811da177e4SLinus Torvalds 821da177e4SLinus Torvalds 831da177e4SLinus Torvalds /* #define DEBUG_CFI_FEATURES */ 841da177e4SLinus Torvalds 851da177e4SLinus Torvalds 861da177e4SLinus Torvalds #ifdef DEBUG_CFI_FEATURES 871da177e4SLinus Torvalds static void cfi_tell_features(struct cfi_pri_amdstd *extp) 881da177e4SLinus Torvalds { 891da177e4SLinus Torvalds const char* erase_suspend[3] = { 901da177e4SLinus Torvalds "Not supported", "Read only", "Read/write" 911da177e4SLinus Torvalds }; 921da177e4SLinus Torvalds const char* top_bottom[6] = { 931da177e4SLinus Torvalds "No WP", "8x8KiB sectors at top & bottom, no WP", 941da177e4SLinus Torvalds "Bottom boot", "Top boot", 951da177e4SLinus Torvalds "Uniform, Bottom WP", "Uniform, Top WP" 961da177e4SLinus Torvalds }; 971da177e4SLinus Torvalds 981da177e4SLinus Torvalds printk(" Silicon revision: %d\n", extp->SiliconRevision >> 1); 991da177e4SLinus Torvalds printk(" Address sensitive unlock: %s\n", 1001da177e4SLinus Torvalds (extp->SiliconRevision & 1) ? "Not required" : "Required"); 1011da177e4SLinus Torvalds 1021da177e4SLinus Torvalds if (extp->EraseSuspend < ARRAY_SIZE(erase_suspend)) 1031da177e4SLinus Torvalds printk(" Erase Suspend: %s\n", erase_suspend[extp->EraseSuspend]); 1041da177e4SLinus Torvalds else 1051da177e4SLinus Torvalds printk(" Erase Suspend: Unknown value %d\n", extp->EraseSuspend); 1061da177e4SLinus Torvalds 1071da177e4SLinus Torvalds if (extp->BlkProt == 0) 1081da177e4SLinus Torvalds printk(" Block protection: Not supported\n"); 1091da177e4SLinus Torvalds else 1101da177e4SLinus Torvalds printk(" Block protection: %d sectors per group\n", extp->BlkProt); 1111da177e4SLinus Torvalds 1121da177e4SLinus Torvalds 1131da177e4SLinus Torvalds printk(" Temporary block unprotect: %s\n", 1141da177e4SLinus Torvalds extp->TmpBlkUnprotect ? "Supported" : "Not supported"); 1151da177e4SLinus Torvalds printk(" Block protect/unprotect scheme: %d\n", extp->BlkProtUnprot); 1161da177e4SLinus Torvalds printk(" Number of simultaneous operations: %d\n", extp->SimultaneousOps); 1171da177e4SLinus Torvalds printk(" Burst mode: %s\n", 1181da177e4SLinus Torvalds extp->BurstMode ? "Supported" : "Not supported"); 1191da177e4SLinus Torvalds if (extp->PageMode == 0) 1201da177e4SLinus Torvalds printk(" Page mode: Not supported\n"); 1211da177e4SLinus Torvalds else 1221da177e4SLinus Torvalds printk(" Page mode: %d word page\n", extp->PageMode << 2); 1231da177e4SLinus Torvalds 1241da177e4SLinus Torvalds printk(" Vpp Supply Minimum Program/Erase Voltage: %d.%d V\n", 1251da177e4SLinus Torvalds extp->VppMin >> 4, extp->VppMin & 0xf); 1261da177e4SLinus Torvalds printk(" Vpp Supply Maximum Program/Erase Voltage: %d.%d V\n", 1271da177e4SLinus Torvalds extp->VppMax >> 4, extp->VppMax & 0xf); 1281da177e4SLinus Torvalds 1291da177e4SLinus Torvalds if (extp->TopBottom < ARRAY_SIZE(top_bottom)) 1301da177e4SLinus Torvalds printk(" Top/Bottom Boot Block: %s\n", top_bottom[extp->TopBottom]); 1311da177e4SLinus Torvalds else 1321da177e4SLinus Torvalds printk(" Top/Bottom Boot Block: Unknown value %d\n", extp->TopBottom); 1331da177e4SLinus Torvalds } 1341da177e4SLinus Torvalds #endif 1351da177e4SLinus Torvalds 1361da177e4SLinus Torvalds #ifdef AMD_BOOTLOC_BUG 1371da177e4SLinus Torvalds /* Wheee. Bring me the head of someone at AMD. */ 1381da177e4SLinus Torvalds static void fixup_amd_bootblock(struct mtd_info *mtd, void* param) 1391da177e4SLinus Torvalds { 1401da177e4SLinus Torvalds struct map_info *map = mtd->priv; 1411da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 1421da177e4SLinus Torvalds struct cfi_pri_amdstd *extp = cfi->cmdset_priv; 1431da177e4SLinus Torvalds __u8 major = extp->MajorVersion; 1441da177e4SLinus Torvalds __u8 minor = extp->MinorVersion; 1451da177e4SLinus Torvalds 1461da177e4SLinus Torvalds if (((major << 8) | minor) < 0x3131) { 1471da177e4SLinus Torvalds /* CFI version 1.0 => don't trust bootloc */ 14887e92c06SChristopher Moore 14987e92c06SChristopher Moore DEBUG(MTD_DEBUG_LEVEL1, 15087e92c06SChristopher Moore "%s: JEDEC Vendor ID is 0x%02X Device ID is 0x%02X\n", 15187e92c06SChristopher Moore map->name, cfi->mfr, cfi->id); 15287e92c06SChristopher Moore 15387e92c06SChristopher Moore /* AFAICS all 29LV400 with a bottom boot block have a device ID 15487e92c06SChristopher Moore * of 0x22BA in 16-bit mode and 0xBA in 8-bit mode. 15587e92c06SChristopher Moore * These were badly detected as they have the 0x80 bit set 15687e92c06SChristopher Moore * so treat them as a special case. 15787e92c06SChristopher Moore */ 15887e92c06SChristopher Moore if (((cfi->id == 0xBA) || (cfi->id == 0x22BA)) && 15987e92c06SChristopher Moore 16087e92c06SChristopher Moore /* Macronix added CFI to their 2nd generation 16187e92c06SChristopher Moore * MX29LV400C B/T but AFAICS no other 29LV400 (AMD, 16287e92c06SChristopher Moore * Fujitsu, Spansion, EON, ESI and older Macronix) 16387e92c06SChristopher Moore * has CFI. 16487e92c06SChristopher Moore * 16587e92c06SChristopher Moore * Therefore also check the manufacturer. 16687e92c06SChristopher Moore * This reduces the risk of false detection due to 16787e92c06SChristopher Moore * the 8-bit device ID. 16887e92c06SChristopher Moore */ 169f3e69c65SGuillaume LECERF (cfi->mfr == CFI_MFR_MACRONIX)) { 17087e92c06SChristopher Moore DEBUG(MTD_DEBUG_LEVEL1, 17187e92c06SChristopher Moore "%s: Macronix MX29LV400C with bottom boot block" 17287e92c06SChristopher Moore " detected\n", map->name); 17387e92c06SChristopher Moore extp->TopBottom = 2; /* bottom boot */ 17487e92c06SChristopher Moore } else 1751da177e4SLinus Torvalds if (cfi->id & 0x80) { 1761da177e4SLinus Torvalds printk(KERN_WARNING "%s: JEDEC Device ID is 0x%02X. Assuming broken CFI table.\n", map->name, cfi->id); 1771da177e4SLinus Torvalds extp->TopBottom = 3; /* top boot */ 1781da177e4SLinus Torvalds } else { 1791da177e4SLinus Torvalds extp->TopBottom = 2; /* bottom boot */ 1801da177e4SLinus Torvalds } 18187e92c06SChristopher Moore 18287e92c06SChristopher Moore DEBUG(MTD_DEBUG_LEVEL1, 18387e92c06SChristopher Moore "%s: AMD CFI PRI V%c.%c has no boot block field;" 18487e92c06SChristopher Moore " deduced %s from Device ID\n", map->name, major, minor, 18587e92c06SChristopher Moore extp->TopBottom == 2 ? "bottom" : "top"); 1861da177e4SLinus Torvalds } 1871da177e4SLinus Torvalds } 1881da177e4SLinus Torvalds #endif 1891da177e4SLinus Torvalds 1901da177e4SLinus Torvalds static void fixup_use_write_buffers(struct mtd_info *mtd, void *param) 1911da177e4SLinus Torvalds { 1921da177e4SLinus Torvalds struct map_info *map = mtd->priv; 1931da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 1941da177e4SLinus Torvalds if (cfi->cfiq->BufWriteTimeoutTyp) { 1951da177e4SLinus Torvalds DEBUG(MTD_DEBUG_LEVEL1, "Using buffer write method\n" ); 1961da177e4SLinus Torvalds mtd->write = cfi_amdstd_write_buffers; 1971da177e4SLinus Torvalds } 1981da177e4SLinus Torvalds } 1991da177e4SLinus Torvalds 2005b0c5c2cSHaavard Skinnemoen /* Atmel chips don't use the same PRI format as AMD chips */ 2015b0c5c2cSHaavard Skinnemoen static void fixup_convert_atmel_pri(struct mtd_info *mtd, void *param) 2025b0c5c2cSHaavard Skinnemoen { 2035b0c5c2cSHaavard Skinnemoen struct map_info *map = mtd->priv; 2045b0c5c2cSHaavard Skinnemoen struct cfi_private *cfi = map->fldrv_priv; 2055b0c5c2cSHaavard Skinnemoen struct cfi_pri_amdstd *extp = cfi->cmdset_priv; 2065b0c5c2cSHaavard Skinnemoen struct cfi_pri_atmel atmel_pri; 2075b0c5c2cSHaavard Skinnemoen 2085b0c5c2cSHaavard Skinnemoen memcpy(&atmel_pri, extp, sizeof(atmel_pri)); 209de591dacSHåvard Skinnemoen memset((char *)extp + 5, 0, sizeof(*extp) - 5); 2105b0c5c2cSHaavard Skinnemoen 2115b0c5c2cSHaavard Skinnemoen if (atmel_pri.Features & 0x02) 2125b0c5c2cSHaavard Skinnemoen extp->EraseSuspend = 2; 2135b0c5c2cSHaavard Skinnemoen 214be8f78b8SHaavard Skinnemoen /* Some chips got it backwards... */ 215be8f78b8SHaavard Skinnemoen if (cfi->id == AT49BV6416) { 216be8f78b8SHaavard Skinnemoen if (atmel_pri.BottomBoot) 217be8f78b8SHaavard Skinnemoen extp->TopBottom = 3; 218be8f78b8SHaavard Skinnemoen else 219be8f78b8SHaavard Skinnemoen extp->TopBottom = 2; 220be8f78b8SHaavard Skinnemoen } else { 2215b0c5c2cSHaavard Skinnemoen if (atmel_pri.BottomBoot) 2225b0c5c2cSHaavard Skinnemoen extp->TopBottom = 2; 2235b0c5c2cSHaavard Skinnemoen else 2245b0c5c2cSHaavard Skinnemoen extp->TopBottom = 3; 225be8f78b8SHaavard Skinnemoen } 226d10a39d1SHans-Christian Egtvedt 227d10a39d1SHans-Christian Egtvedt /* burst write mode not supported */ 228d10a39d1SHans-Christian Egtvedt cfi->cfiq->BufWriteTimeoutTyp = 0; 229d10a39d1SHans-Christian Egtvedt cfi->cfiq->BufWriteTimeoutMax = 0; 2305b0c5c2cSHaavard Skinnemoen } 2315b0c5c2cSHaavard Skinnemoen 2321da177e4SLinus Torvalds static void fixup_use_secsi(struct mtd_info *mtd, void *param) 2331da177e4SLinus Torvalds { 2341da177e4SLinus Torvalds /* Setup for chips with a secsi area */ 2351da177e4SLinus Torvalds mtd->read_user_prot_reg = cfi_amdstd_secsi_read; 2361da177e4SLinus Torvalds mtd->read_fact_prot_reg = cfi_amdstd_secsi_read; 2371da177e4SLinus Torvalds } 2381da177e4SLinus Torvalds 2391da177e4SLinus Torvalds static void fixup_use_erase_chip(struct mtd_info *mtd, void *param) 2401da177e4SLinus Torvalds { 2411da177e4SLinus Torvalds struct map_info *map = mtd->priv; 2421da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 2431da177e4SLinus Torvalds if ((cfi->cfiq->NumEraseRegions == 1) && 2441da177e4SLinus Torvalds ((cfi->cfiq->EraseRegionInfo[0] & 0xffff) == 0)) { 2451da177e4SLinus Torvalds mtd->erase = cfi_amdstd_erase_chip; 2461da177e4SLinus Torvalds } 2471da177e4SLinus Torvalds 2481da177e4SLinus Torvalds } 2491da177e4SLinus Torvalds 2500165508cSHaavard Skinnemoen /* 2510165508cSHaavard Skinnemoen * Some Atmel chips (e.g. the AT49BV6416) power-up with all sectors 2520165508cSHaavard Skinnemoen * locked by default. 2530165508cSHaavard Skinnemoen */ 2540165508cSHaavard Skinnemoen static void fixup_use_atmel_lock(struct mtd_info *mtd, void *param) 2550165508cSHaavard Skinnemoen { 2560165508cSHaavard Skinnemoen mtd->lock = cfi_atmel_lock; 2570165508cSHaavard Skinnemoen mtd->unlock = cfi_atmel_unlock; 258e619a75fSJustin Treon mtd->flags |= MTD_POWERUP_LOCK; 2590165508cSHaavard Skinnemoen } 2600165508cSHaavard Skinnemoen 26170b07255STrent Piepho static void fixup_s29gl064n_sectors(struct mtd_info *mtd, void *param) 26270b07255STrent Piepho { 26370b07255STrent Piepho struct map_info *map = mtd->priv; 26470b07255STrent Piepho struct cfi_private *cfi = map->fldrv_priv; 26570b07255STrent Piepho 26670b07255STrent Piepho if ((cfi->cfiq->EraseRegionInfo[0] & 0xffff) == 0x003f) { 26770b07255STrent Piepho cfi->cfiq->EraseRegionInfo[0] |= 0x0040; 26870b07255STrent Piepho pr_warning("%s: Bad S29GL064N CFI data, adjust from 64 to 128 sectors\n", mtd->name); 26970b07255STrent Piepho } 27070b07255STrent Piepho } 27170b07255STrent Piepho 27270b07255STrent Piepho static void fixup_s29gl032n_sectors(struct mtd_info *mtd, void *param) 27370b07255STrent Piepho { 27470b07255STrent Piepho struct map_info *map = mtd->priv; 27570b07255STrent Piepho struct cfi_private *cfi = map->fldrv_priv; 27670b07255STrent Piepho 27770b07255STrent Piepho if ((cfi->cfiq->EraseRegionInfo[1] & 0xffff) == 0x007e) { 27870b07255STrent Piepho cfi->cfiq->EraseRegionInfo[1] &= ~0x0040; 27970b07255STrent Piepho pr_warning("%s: Bad S29GL032N CFI data, adjust from 127 to 63 sectors\n", mtd->name); 28070b07255STrent Piepho } 28170b07255STrent Piepho } 28270b07255STrent Piepho 2831da177e4SLinus Torvalds static struct cfi_fixup cfi_fixup_table[] = { 284d10a39d1SHans-Christian Egtvedt { CFI_MFR_ATMEL, CFI_ID_ANY, fixup_convert_atmel_pri, NULL }, 2851da177e4SLinus Torvalds #ifdef AMD_BOOTLOC_BUG 2861da177e4SLinus Torvalds { CFI_MFR_AMD, CFI_ID_ANY, fixup_amd_bootblock, NULL }, 287f3e69c65SGuillaume LECERF { CFI_MFR_MACRONIX, CFI_ID_ANY, fixup_amd_bootblock, NULL }, 2881da177e4SLinus Torvalds #endif 2891da177e4SLinus Torvalds { CFI_MFR_AMD, 0x0050, fixup_use_secsi, NULL, }, 2901da177e4SLinus Torvalds { CFI_MFR_AMD, 0x0053, fixup_use_secsi, NULL, }, 2911da177e4SLinus Torvalds { CFI_MFR_AMD, 0x0055, fixup_use_secsi, NULL, }, 2921da177e4SLinus Torvalds { CFI_MFR_AMD, 0x0056, fixup_use_secsi, NULL, }, 2931da177e4SLinus Torvalds { CFI_MFR_AMD, 0x005C, fixup_use_secsi, NULL, }, 2941da177e4SLinus Torvalds { CFI_MFR_AMD, 0x005F, fixup_use_secsi, NULL, }, 29570b07255STrent Piepho { CFI_MFR_AMD, 0x0c01, fixup_s29gl064n_sectors, NULL, }, 29670b07255STrent Piepho { CFI_MFR_AMD, 0x1301, fixup_s29gl064n_sectors, NULL, }, 29770b07255STrent Piepho { CFI_MFR_AMD, 0x1a00, fixup_s29gl032n_sectors, NULL, }, 29870b07255STrent Piepho { CFI_MFR_AMD, 0x1a01, fixup_s29gl032n_sectors, NULL, }, 2991da177e4SLinus Torvalds #if !FORCE_WORD_WRITE 3001da177e4SLinus Torvalds { CFI_MFR_ANY, CFI_ID_ANY, fixup_use_write_buffers, NULL, }, 3011da177e4SLinus Torvalds #endif 3021da177e4SLinus Torvalds { 0, 0, NULL, NULL } 3031da177e4SLinus Torvalds }; 3041da177e4SLinus Torvalds static struct cfi_fixup jedec_fixup_table[] = { 305f3e69c65SGuillaume LECERF { CFI_MFR_SST, SST49LF004B, fixup_use_fwh_lock, NULL, }, 306f3e69c65SGuillaume LECERF { CFI_MFR_SST, SST49LF040B, fixup_use_fwh_lock, NULL, }, 307f3e69c65SGuillaume LECERF { CFI_MFR_SST, SST49LF008A, fixup_use_fwh_lock, NULL, }, 3081da177e4SLinus Torvalds { 0, 0, NULL, NULL } 3091da177e4SLinus Torvalds }; 3101da177e4SLinus Torvalds 3111da177e4SLinus Torvalds static struct cfi_fixup fixup_table[] = { 3121da177e4SLinus Torvalds /* The CFI vendor ids and the JEDEC vendor IDs appear 3131da177e4SLinus Torvalds * to be common. It is like the devices id's are as 3141da177e4SLinus Torvalds * well. This table is to pick all cases where 3151da177e4SLinus Torvalds * we know that is the case. 3161da177e4SLinus Torvalds */ 3171da177e4SLinus Torvalds { CFI_MFR_ANY, CFI_ID_ANY, fixup_use_erase_chip, NULL }, 3180165508cSHaavard Skinnemoen { CFI_MFR_ATMEL, AT49BV6416, fixup_use_atmel_lock, NULL }, 3191da177e4SLinus Torvalds { 0, 0, NULL, NULL } 3201da177e4SLinus Torvalds }; 3211da177e4SLinus Torvalds 3221da177e4SLinus Torvalds 323fefae48bSWolfgang Grandegger static void cfi_fixup_major_minor(struct cfi_private *cfi, 324fefae48bSWolfgang Grandegger struct cfi_pri_amdstd *extp) 325fefae48bSWolfgang Grandegger { 326fefae48bSWolfgang Grandegger if (cfi->mfr == CFI_MFR_SAMSUNG && cfi->id == 0x257e && 327fefae48bSWolfgang Grandegger extp->MajorVersion == '0') 328fefae48bSWolfgang Grandegger extp->MajorVersion = '1'; 329fefae48bSWolfgang Grandegger } 330fefae48bSWolfgang Grandegger 3311da177e4SLinus Torvalds struct mtd_info *cfi_cmdset_0002(struct map_info *map, int primary) 3321da177e4SLinus Torvalds { 3331da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 3341da177e4SLinus Torvalds struct mtd_info *mtd; 3351da177e4SLinus Torvalds int i; 3361da177e4SLinus Torvalds 33795b93a0cSBurman Yan mtd = kzalloc(sizeof(*mtd), GFP_KERNEL); 3381da177e4SLinus Torvalds if (!mtd) { 3391da177e4SLinus Torvalds printk(KERN_WARNING "Failed to allocate memory for MTD device\n"); 3401da177e4SLinus Torvalds return NULL; 3411da177e4SLinus Torvalds } 3421da177e4SLinus Torvalds mtd->priv = map; 3431da177e4SLinus Torvalds mtd->type = MTD_NORFLASH; 3441da177e4SLinus Torvalds 3451da177e4SLinus Torvalds /* Fill in the default mtd operations */ 3461da177e4SLinus Torvalds mtd->erase = cfi_amdstd_erase_varsize; 3471da177e4SLinus Torvalds mtd->write = cfi_amdstd_write_words; 3481da177e4SLinus Torvalds mtd->read = cfi_amdstd_read; 3491da177e4SLinus Torvalds mtd->sync = cfi_amdstd_sync; 3501da177e4SLinus Torvalds mtd->suspend = cfi_amdstd_suspend; 3511da177e4SLinus Torvalds mtd->resume = cfi_amdstd_resume; 3521da177e4SLinus Torvalds mtd->flags = MTD_CAP_NORFLASH; 3531da177e4SLinus Torvalds mtd->name = map->name; 354783ed81fSArtem B. Bityutskiy mtd->writesize = 1; 3551da177e4SLinus Torvalds 356eafe1311SKevin Cernekee mtd->reboot_notifier.notifier_call = cfi_amdstd_reboot; 357eafe1311SKevin Cernekee 3581da177e4SLinus Torvalds if (cfi->cfi_mode==CFI_MODE_CFI){ 3591da177e4SLinus Torvalds unsigned char bootloc; 3601da177e4SLinus Torvalds __u16 adr = primary?cfi->cfiq->P_ADR:cfi->cfiq->A_ADR; 3611da177e4SLinus Torvalds struct cfi_pri_amdstd *extp; 3621da177e4SLinus Torvalds 3631da177e4SLinus Torvalds extp = (struct cfi_pri_amdstd*)cfi_read_pri(map, adr, sizeof(*extp), "Amd/Fujitsu"); 364564b8497SGuillaume LECERF if (extp) { 365564b8497SGuillaume LECERF /* 366564b8497SGuillaume LECERF * It's a real CFI chip, not one for which the probe 367564b8497SGuillaume LECERF * routine faked a CFI structure. 368564b8497SGuillaume LECERF */ 369fefae48bSWolfgang Grandegger cfi_fixup_major_minor(cfi, extp); 370fefae48bSWolfgang Grandegger 371d88f977bSTodd Poynor if (extp->MajorVersion != '1' || 372d88f977bSTodd Poynor (extp->MinorVersion < '0' || extp->MinorVersion > '4')) { 373d88f977bSTodd Poynor printk(KERN_ERR " Unknown Amd/Fujitsu Extended Query " 374d88f977bSTodd Poynor "version %c.%c.\n", extp->MajorVersion, 375d88f977bSTodd Poynor extp->MinorVersion); 376d88f977bSTodd Poynor kfree(extp); 377d88f977bSTodd Poynor kfree(mtd); 378d88f977bSTodd Poynor return NULL; 379d88f977bSTodd Poynor } 380d88f977bSTodd Poynor 3811da177e4SLinus Torvalds /* Install our own private info structure */ 3821da177e4SLinus Torvalds cfi->cmdset_priv = extp; 3831da177e4SLinus Torvalds 3841da177e4SLinus Torvalds /* Apply cfi device specific fixups */ 3851da177e4SLinus Torvalds cfi_fixup(mtd, cfi_fixup_table); 3861da177e4SLinus Torvalds 3871da177e4SLinus Torvalds #ifdef DEBUG_CFI_FEATURES 3881da177e4SLinus Torvalds /* Tell the user about it in lots of lovely detail */ 3891da177e4SLinus Torvalds cfi_tell_features(extp); 3901da177e4SLinus Torvalds #endif 3911da177e4SLinus Torvalds 3921da177e4SLinus Torvalds bootloc = extp->TopBottom; 393412da2f6SDavid Woodhouse if ((bootloc < 2) || (bootloc > 5)) { 394412da2f6SDavid Woodhouse printk(KERN_WARNING "%s: CFI contains unrecognised boot " 395412da2f6SDavid Woodhouse "bank location (%d). Assuming bottom.\n", 396412da2f6SDavid Woodhouse bootloc, map->name); 3971da177e4SLinus Torvalds bootloc = 2; 3981da177e4SLinus Torvalds } 3991da177e4SLinus Torvalds 4001da177e4SLinus Torvalds if (bootloc == 3 && cfi->cfiq->NumEraseRegions > 1) { 401412da2f6SDavid Woodhouse printk(KERN_WARNING "%s: Swapping erase regions for top-boot CFI table.\n", map->name); 4021da177e4SLinus Torvalds 4031da177e4SLinus Torvalds for (i=0; i<cfi->cfiq->NumEraseRegions / 2; i++) { 4041da177e4SLinus Torvalds int j = (cfi->cfiq->NumEraseRegions-1)-i; 4051da177e4SLinus Torvalds __u32 swap; 4061da177e4SLinus Torvalds 4071da177e4SLinus Torvalds swap = cfi->cfiq->EraseRegionInfo[i]; 4081da177e4SLinus Torvalds cfi->cfiq->EraseRegionInfo[i] = cfi->cfiq->EraseRegionInfo[j]; 4091da177e4SLinus Torvalds cfi->cfiq->EraseRegionInfo[j] = swap; 4101da177e4SLinus Torvalds } 4111da177e4SLinus Torvalds } 4121da177e4SLinus Torvalds /* Set the default CFI lock/unlock addresses */ 4131da177e4SLinus Torvalds cfi->addr_unlock1 = 0x555; 4141da177e4SLinus Torvalds cfi->addr_unlock2 = 0x2aa; 415564b8497SGuillaume LECERF } 416564b8497SGuillaume LECERF 417564b8497SGuillaume LECERF if (!cfi->addr_unlock1 || !cfi->addr_unlock2) { 418564b8497SGuillaume LECERF kfree(mtd); 419564b8497SGuillaume LECERF return NULL; 420564b8497SGuillaume LECERF } 4211da177e4SLinus Torvalds 4221da177e4SLinus Torvalds } /* CFI mode */ 4231da177e4SLinus Torvalds else if (cfi->cfi_mode == CFI_MODE_JEDEC) { 4241da177e4SLinus Torvalds /* Apply jedec specific fixups */ 4251da177e4SLinus Torvalds cfi_fixup(mtd, jedec_fixup_table); 4261da177e4SLinus Torvalds } 4271da177e4SLinus Torvalds /* Apply generic fixups */ 4281da177e4SLinus Torvalds cfi_fixup(mtd, fixup_table); 4291da177e4SLinus Torvalds 4301da177e4SLinus Torvalds for (i=0; i< cfi->numchips; i++) { 4311da177e4SLinus Torvalds cfi->chips[i].word_write_time = 1<<cfi->cfiq->WordWriteTimeoutTyp; 4321da177e4SLinus Torvalds cfi->chips[i].buffer_write_time = 1<<cfi->cfiq->BufWriteTimeoutTyp; 4331da177e4SLinus Torvalds cfi->chips[i].erase_time = 1<<cfi->cfiq->BlockEraseTimeoutTyp; 43483d48091SVijay Sampath cfi->chips[i].ref_point_counter = 0; 43583d48091SVijay Sampath init_waitqueue_head(&(cfi->chips[i].wq)); 4361da177e4SLinus Torvalds } 4371da177e4SLinus Torvalds 4381da177e4SLinus Torvalds map->fldrv = &cfi_amdstd_chipdrv; 4391da177e4SLinus Torvalds 4401da177e4SLinus Torvalds return cfi_amdstd_setup(mtd); 4411da177e4SLinus Torvalds } 44283ea4ef2SDavid Woodhouse EXPORT_SYMBOL_GPL(cfi_cmdset_0002); 4431da177e4SLinus Torvalds 4441da177e4SLinus Torvalds static struct mtd_info *cfi_amdstd_setup(struct mtd_info *mtd) 4451da177e4SLinus Torvalds { 4461da177e4SLinus Torvalds struct map_info *map = mtd->priv; 4471da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 4481da177e4SLinus Torvalds unsigned long devsize = (1<<cfi->cfiq->DevSize) * cfi->interleave; 4491da177e4SLinus Torvalds unsigned long offset = 0; 4501da177e4SLinus Torvalds int i,j; 4511da177e4SLinus Torvalds 4521da177e4SLinus Torvalds printk(KERN_NOTICE "number of %s chips: %d\n", 4531da177e4SLinus Torvalds (cfi->cfi_mode == CFI_MODE_CFI)?"CFI":"JEDEC",cfi->numchips); 4541da177e4SLinus Torvalds /* Select the correct geometry setup */ 4551da177e4SLinus Torvalds mtd->size = devsize * cfi->numchips; 4561da177e4SLinus Torvalds 4571da177e4SLinus Torvalds mtd->numeraseregions = cfi->cfiq->NumEraseRegions * cfi->numchips; 4581da177e4SLinus Torvalds mtd->eraseregions = kmalloc(sizeof(struct mtd_erase_region_info) 4591da177e4SLinus Torvalds * mtd->numeraseregions, GFP_KERNEL); 4601da177e4SLinus Torvalds if (!mtd->eraseregions) { 4611da177e4SLinus Torvalds printk(KERN_WARNING "Failed to allocate memory for MTD erase region info\n"); 4621da177e4SLinus Torvalds goto setup_err; 4631da177e4SLinus Torvalds } 4641da177e4SLinus Torvalds 4651da177e4SLinus Torvalds for (i=0; i<cfi->cfiq->NumEraseRegions; i++) { 4661da177e4SLinus Torvalds unsigned long ernum, ersize; 4671da177e4SLinus Torvalds ersize = ((cfi->cfiq->EraseRegionInfo[i] >> 8) & ~0xff) * cfi->interleave; 4681da177e4SLinus Torvalds ernum = (cfi->cfiq->EraseRegionInfo[i] & 0xffff) + 1; 4691da177e4SLinus Torvalds 4701da177e4SLinus Torvalds if (mtd->erasesize < ersize) { 4711da177e4SLinus Torvalds mtd->erasesize = ersize; 4721da177e4SLinus Torvalds } 4731da177e4SLinus Torvalds for (j=0; j<cfi->numchips; j++) { 4741da177e4SLinus Torvalds mtd->eraseregions[(j*cfi->cfiq->NumEraseRegions)+i].offset = (j*devsize)+offset; 4751da177e4SLinus Torvalds mtd->eraseregions[(j*cfi->cfiq->NumEraseRegions)+i].erasesize = ersize; 4761da177e4SLinus Torvalds mtd->eraseregions[(j*cfi->cfiq->NumEraseRegions)+i].numblocks = ernum; 4771da177e4SLinus Torvalds } 4781da177e4SLinus Torvalds offset += (ersize * ernum); 4791da177e4SLinus Torvalds } 4801da177e4SLinus Torvalds if (offset != devsize) { 4811da177e4SLinus Torvalds /* Argh */ 4821da177e4SLinus Torvalds printk(KERN_WARNING "Sum of regions (%lx) != total size of set of interleaved chips (%lx)\n", offset, devsize); 4831da177e4SLinus Torvalds goto setup_err; 4841da177e4SLinus Torvalds } 4851da177e4SLinus Torvalds #if 0 4861da177e4SLinus Torvalds // debug 4871da177e4SLinus Torvalds for (i=0; i<mtd->numeraseregions;i++){ 4881da177e4SLinus Torvalds printk("%d: offset=0x%x,size=0x%x,blocks=%d\n", 4891da177e4SLinus Torvalds i,mtd->eraseregions[i].offset, 4901da177e4SLinus Torvalds mtd->eraseregions[i].erasesize, 4911da177e4SLinus Torvalds mtd->eraseregions[i].numblocks); 4921da177e4SLinus Torvalds } 4931da177e4SLinus Torvalds #endif 4941da177e4SLinus Torvalds 4951da177e4SLinus Torvalds __module_get(THIS_MODULE); 496eafe1311SKevin Cernekee register_reboot_notifier(&mtd->reboot_notifier); 4971da177e4SLinus Torvalds return mtd; 4981da177e4SLinus Torvalds 4991da177e4SLinus Torvalds setup_err: 5001da177e4SLinus Torvalds kfree(mtd->eraseregions); 5011da177e4SLinus Torvalds kfree(mtd); 5021da177e4SLinus Torvalds kfree(cfi->cmdset_priv); 5031da177e4SLinus Torvalds kfree(cfi->cfiq); 5041da177e4SLinus Torvalds return NULL; 5051da177e4SLinus Torvalds } 5061da177e4SLinus Torvalds 5071da177e4SLinus Torvalds /* 5081da177e4SLinus Torvalds * Return true if the chip is ready. 5091da177e4SLinus Torvalds * 5101da177e4SLinus Torvalds * Ready is one of: read mode, query mode, erase-suspend-read mode (in any 5111da177e4SLinus Torvalds * non-suspended sector) and is indicated by no toggle bits toggling. 5121da177e4SLinus Torvalds * 5131da177e4SLinus Torvalds * Note that anything more complicated than checking if no bits are toggling 5141da177e4SLinus Torvalds * (including checking DQ5 for an error status) is tricky to get working 5151da177e4SLinus Torvalds * correctly and is therefore not done (particulary with interleaved chips 5161da177e4SLinus Torvalds * as each chip must be checked independantly of the others). 5171da177e4SLinus Torvalds */ 51802b15e34STodd Poynor static int __xipram chip_ready(struct map_info *map, unsigned long addr) 5191da177e4SLinus Torvalds { 5201da177e4SLinus Torvalds map_word d, t; 5211da177e4SLinus Torvalds 5221da177e4SLinus Torvalds d = map_read(map, addr); 5231da177e4SLinus Torvalds t = map_read(map, addr); 5241da177e4SLinus Torvalds 5251da177e4SLinus Torvalds return map_word_equal(map, d, t); 5261da177e4SLinus Torvalds } 5271da177e4SLinus Torvalds 528fb4a90bfSEric W. Biedermann /* 529fb4a90bfSEric W. Biedermann * Return true if the chip is ready and has the correct value. 530fb4a90bfSEric W. Biedermann * 531fb4a90bfSEric W. Biedermann * Ready is one of: read mode, query mode, erase-suspend-read mode (in any 532fb4a90bfSEric W. Biedermann * non-suspended sector) and it is indicated by no bits toggling. 533fb4a90bfSEric W. Biedermann * 534fb4a90bfSEric W. Biedermann * Error are indicated by toggling bits or bits held with the wrong value, 535fb4a90bfSEric W. Biedermann * or with bits toggling. 536fb4a90bfSEric W. Biedermann * 537fb4a90bfSEric W. Biedermann * Note that anything more complicated than checking if no bits are toggling 538fb4a90bfSEric W. Biedermann * (including checking DQ5 for an error status) is tricky to get working 539fb4a90bfSEric W. Biedermann * correctly and is therefore not done (particulary with interleaved chips 540fb4a90bfSEric W. Biedermann * as each chip must be checked independantly of the others). 541fb4a90bfSEric W. Biedermann * 542fb4a90bfSEric W. Biedermann */ 54302b15e34STodd Poynor static int __xipram chip_good(struct map_info *map, unsigned long addr, map_word expected) 544fb4a90bfSEric W. Biedermann { 545fb4a90bfSEric W. Biedermann map_word oldd, curd; 546fb4a90bfSEric W. Biedermann 547fb4a90bfSEric W. Biedermann oldd = map_read(map, addr); 548fb4a90bfSEric W. Biedermann curd = map_read(map, addr); 549fb4a90bfSEric W. Biedermann 550fb4a90bfSEric W. Biedermann return map_word_equal(map, oldd, curd) && 551fb4a90bfSEric W. Biedermann map_word_equal(map, curd, expected); 552fb4a90bfSEric W. Biedermann } 553fb4a90bfSEric W. Biedermann 5541da177e4SLinus Torvalds static int get_chip(struct map_info *map, struct flchip *chip, unsigned long adr, int mode) 5551da177e4SLinus Torvalds { 5561da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 5571da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 5581da177e4SLinus Torvalds unsigned long timeo; 5591da177e4SLinus Torvalds struct cfi_pri_amdstd *cfip = (struct cfi_pri_amdstd *)cfi->cmdset_priv; 5601da177e4SLinus Torvalds 5611da177e4SLinus Torvalds resettime: 5621da177e4SLinus Torvalds timeo = jiffies + HZ; 5631da177e4SLinus Torvalds retry: 5641da177e4SLinus Torvalds switch (chip->state) { 5651da177e4SLinus Torvalds 5661da177e4SLinus Torvalds case FL_STATUS: 5671da177e4SLinus Torvalds for (;;) { 5681da177e4SLinus Torvalds if (chip_ready(map, adr)) 5691da177e4SLinus Torvalds break; 5701da177e4SLinus Torvalds 5711da177e4SLinus Torvalds if (time_after(jiffies, timeo)) { 5721da177e4SLinus Torvalds printk(KERN_ERR "Waiting for chip to be ready timed out.\n"); 5731da177e4SLinus Torvalds return -EIO; 5741da177e4SLinus Torvalds } 575c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 5761da177e4SLinus Torvalds cfi_udelay(1); 577c4e77376SStefani Seibold mutex_lock(&chip->mutex); 5781da177e4SLinus Torvalds /* Someone else might have been playing with it. */ 5791da177e4SLinus Torvalds goto retry; 5801da177e4SLinus Torvalds } 5811da177e4SLinus Torvalds 5821da177e4SLinus Torvalds case FL_READY: 5831da177e4SLinus Torvalds case FL_CFI_QUERY: 5841da177e4SLinus Torvalds case FL_JEDEC_QUERY: 5851da177e4SLinus Torvalds return 0; 5861da177e4SLinus Torvalds 5871da177e4SLinus Torvalds case FL_ERASING: 5882695eab9SJoakim Tjernlund if (!cfip || !(cfip->EraseSuspend & (0x1|0x2)) || 5892695eab9SJoakim Tjernlund !(mode == FL_READY || mode == FL_POINT || 5902695eab9SJoakim Tjernlund (mode == FL_WRITING && (cfip->EraseSuspend & 0x2)))) 5911da177e4SLinus Torvalds goto sleep; 5921da177e4SLinus Torvalds 5931da177e4SLinus Torvalds /* We could check to see if we're trying to access the sector 5941da177e4SLinus Torvalds * that is currently being erased. However, no user will try 5951da177e4SLinus Torvalds * anything like that so we just wait for the timeout. */ 5961da177e4SLinus Torvalds 5971da177e4SLinus Torvalds /* Erase suspend */ 5981da177e4SLinus Torvalds /* It's harmless to issue the Erase-Suspend and Erase-Resume 5991da177e4SLinus Torvalds * commands when the erase algorithm isn't in progress. */ 6001da177e4SLinus Torvalds map_write(map, CMD(0xB0), chip->in_progress_block_addr); 6011da177e4SLinus Torvalds chip->oldstate = FL_ERASING; 6021da177e4SLinus Torvalds chip->state = FL_ERASE_SUSPENDING; 6031da177e4SLinus Torvalds chip->erase_suspended = 1; 6041da177e4SLinus Torvalds for (;;) { 6051da177e4SLinus Torvalds if (chip_ready(map, adr)) 6061da177e4SLinus Torvalds break; 6071da177e4SLinus Torvalds 6081da177e4SLinus Torvalds if (time_after(jiffies, timeo)) { 6091da177e4SLinus Torvalds /* Should have suspended the erase by now. 6101da177e4SLinus Torvalds * Send an Erase-Resume command as either 6111da177e4SLinus Torvalds * there was an error (so leave the erase 6121da177e4SLinus Torvalds * routine to recover from it) or we trying to 6131da177e4SLinus Torvalds * use the erase-in-progress sector. */ 6141da177e4SLinus Torvalds map_write(map, CMD(0x30), chip->in_progress_block_addr); 6151da177e4SLinus Torvalds chip->state = FL_ERASING; 6161da177e4SLinus Torvalds chip->oldstate = FL_READY; 6171da177e4SLinus Torvalds printk(KERN_ERR "MTD %s(): chip not ready after erase suspend\n", __func__); 6181da177e4SLinus Torvalds return -EIO; 6191da177e4SLinus Torvalds } 6201da177e4SLinus Torvalds 621c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 6221da177e4SLinus Torvalds cfi_udelay(1); 623c4e77376SStefani Seibold mutex_lock(&chip->mutex); 6241da177e4SLinus Torvalds /* Nobody will touch it while it's in state FL_ERASE_SUSPENDING. 6251da177e4SLinus Torvalds So we can just loop here. */ 6261da177e4SLinus Torvalds } 6271da177e4SLinus Torvalds chip->state = FL_READY; 6281da177e4SLinus Torvalds return 0; 6291da177e4SLinus Torvalds 63002b15e34STodd Poynor case FL_XIP_WHILE_ERASING: 63102b15e34STodd Poynor if (mode != FL_READY && mode != FL_POINT && 63202b15e34STodd Poynor (!cfip || !(cfip->EraseSuspend&2))) 63302b15e34STodd Poynor goto sleep; 63402b15e34STodd Poynor chip->oldstate = chip->state; 63502b15e34STodd Poynor chip->state = FL_READY; 63602b15e34STodd Poynor return 0; 63702b15e34STodd Poynor 638eafe1311SKevin Cernekee case FL_SHUTDOWN: 639eafe1311SKevin Cernekee /* The machine is rebooting */ 640eafe1311SKevin Cernekee return -EIO; 641eafe1311SKevin Cernekee 6421da177e4SLinus Torvalds case FL_POINT: 6431da177e4SLinus Torvalds /* Only if there's no operation suspended... */ 6441da177e4SLinus Torvalds if (mode == FL_READY && chip->oldstate == FL_READY) 6451da177e4SLinus Torvalds return 0; 6461da177e4SLinus Torvalds 6471da177e4SLinus Torvalds default: 6481da177e4SLinus Torvalds sleep: 6491da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 6501da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 651c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 6521da177e4SLinus Torvalds schedule(); 6531da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 654c4e77376SStefani Seibold mutex_lock(&chip->mutex); 6551da177e4SLinus Torvalds goto resettime; 6561da177e4SLinus Torvalds } 6571da177e4SLinus Torvalds } 6581da177e4SLinus Torvalds 6591da177e4SLinus Torvalds 6601da177e4SLinus Torvalds static void put_chip(struct map_info *map, struct flchip *chip, unsigned long adr) 6611da177e4SLinus Torvalds { 6621da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 6631da177e4SLinus Torvalds 6641da177e4SLinus Torvalds switch(chip->oldstate) { 6651da177e4SLinus Torvalds case FL_ERASING: 6661da177e4SLinus Torvalds chip->state = chip->oldstate; 6671da177e4SLinus Torvalds map_write(map, CMD(0x30), chip->in_progress_block_addr); 6681da177e4SLinus Torvalds chip->oldstate = FL_READY; 6691da177e4SLinus Torvalds chip->state = FL_ERASING; 6701da177e4SLinus Torvalds break; 6711da177e4SLinus Torvalds 67202b15e34STodd Poynor case FL_XIP_WHILE_ERASING: 67302b15e34STodd Poynor chip->state = chip->oldstate; 67402b15e34STodd Poynor chip->oldstate = FL_READY; 67502b15e34STodd Poynor break; 67602b15e34STodd Poynor 6771da177e4SLinus Torvalds case FL_READY: 6781da177e4SLinus Torvalds case FL_STATUS: 6791da177e4SLinus Torvalds /* We should really make set_vpp() count, rather than doing this */ 6801da177e4SLinus Torvalds DISABLE_VPP(map); 6811da177e4SLinus Torvalds break; 6821da177e4SLinus Torvalds default: 6831da177e4SLinus Torvalds printk(KERN_ERR "MTD: put_chip() called with oldstate %d!!\n", chip->oldstate); 6841da177e4SLinus Torvalds } 6851da177e4SLinus Torvalds wake_up(&chip->wq); 6861da177e4SLinus Torvalds } 6871da177e4SLinus Torvalds 68802b15e34STodd Poynor #ifdef CONFIG_MTD_XIP 68902b15e34STodd Poynor 69002b15e34STodd Poynor /* 69102b15e34STodd Poynor * No interrupt what so ever can be serviced while the flash isn't in array 69202b15e34STodd Poynor * mode. This is ensured by the xip_disable() and xip_enable() functions 69302b15e34STodd Poynor * enclosing any code path where the flash is known not to be in array mode. 69402b15e34STodd Poynor * And within a XIP disabled code path, only functions marked with __xipram 69502b15e34STodd Poynor * may be called and nothing else (it's a good thing to inspect generated 69602b15e34STodd Poynor * assembly to make sure inline functions were actually inlined and that gcc 69702b15e34STodd Poynor * didn't emit calls to its own support functions). Also configuring MTD CFI 69802b15e34STodd Poynor * support to a single buswidth and a single interleave is also recommended. 69902b15e34STodd Poynor */ 700f8eb321bSThomas Gleixner 70102b15e34STodd Poynor static void xip_disable(struct map_info *map, struct flchip *chip, 70202b15e34STodd Poynor unsigned long adr) 70302b15e34STodd Poynor { 70402b15e34STodd Poynor /* TODO: chips with no XIP use should ignore and return */ 70502b15e34STodd Poynor (void) map_read(map, adr); /* ensure mmu mapping is up to date */ 70602b15e34STodd Poynor local_irq_disable(); 70702b15e34STodd Poynor } 70802b15e34STodd Poynor 70902b15e34STodd Poynor static void __xipram xip_enable(struct map_info *map, struct flchip *chip, 71002b15e34STodd Poynor unsigned long adr) 71102b15e34STodd Poynor { 71202b15e34STodd Poynor struct cfi_private *cfi = map->fldrv_priv; 71302b15e34STodd Poynor 71402b15e34STodd Poynor if (chip->state != FL_POINT && chip->state != FL_READY) { 71502b15e34STodd Poynor map_write(map, CMD(0xf0), adr); 71602b15e34STodd Poynor chip->state = FL_READY; 71702b15e34STodd Poynor } 71802b15e34STodd Poynor (void) map_read(map, adr); 71997f927a4SThomas Gleixner xip_iprefetch(); 72002b15e34STodd Poynor local_irq_enable(); 72102b15e34STodd Poynor } 72202b15e34STodd Poynor 72302b15e34STodd Poynor /* 72402b15e34STodd Poynor * When a delay is required for the flash operation to complete, the 72502b15e34STodd Poynor * xip_udelay() function is polling for both the given timeout and pending 72602b15e34STodd Poynor * (but still masked) hardware interrupts. Whenever there is an interrupt 72702b15e34STodd Poynor * pending then the flash erase operation is suspended, array mode restored 72802b15e34STodd Poynor * and interrupts unmasked. Task scheduling might also happen at that 72902b15e34STodd Poynor * point. The CPU eventually returns from the interrupt or the call to 73002b15e34STodd Poynor * schedule() and the suspended flash operation is resumed for the remaining 73102b15e34STodd Poynor * of the delay period. 73202b15e34STodd Poynor * 73302b15e34STodd Poynor * Warning: this function _will_ fool interrupt latency tracing tools. 73402b15e34STodd Poynor */ 73502b15e34STodd Poynor 73602b15e34STodd Poynor static void __xipram xip_udelay(struct map_info *map, struct flchip *chip, 73702b15e34STodd Poynor unsigned long adr, int usec) 73802b15e34STodd Poynor { 73902b15e34STodd Poynor struct cfi_private *cfi = map->fldrv_priv; 74002b15e34STodd Poynor struct cfi_pri_amdstd *extp = cfi->cmdset_priv; 74102b15e34STodd Poynor map_word status, OK = CMD(0x80); 74202b15e34STodd Poynor unsigned long suspended, start = xip_currtime(); 74302b15e34STodd Poynor flstate_t oldstate; 74402b15e34STodd Poynor 74502b15e34STodd Poynor do { 74602b15e34STodd Poynor cpu_relax(); 74702b15e34STodd Poynor if (xip_irqpending() && extp && 74802b15e34STodd Poynor ((chip->state == FL_ERASING && (extp->EraseSuspend & 2))) && 74902b15e34STodd Poynor (cfi_interleave_is_1(cfi) || chip->oldstate == FL_READY)) { 75002b15e34STodd Poynor /* 75102b15e34STodd Poynor * Let's suspend the erase operation when supported. 75202b15e34STodd Poynor * Note that we currently don't try to suspend 75302b15e34STodd Poynor * interleaved chips if there is already another 75402b15e34STodd Poynor * operation suspended (imagine what happens 75502b15e34STodd Poynor * when one chip was already done with the current 75602b15e34STodd Poynor * operation while another chip suspended it, then 75702b15e34STodd Poynor * we resume the whole thing at once). Yes, it 75802b15e34STodd Poynor * can happen! 75902b15e34STodd Poynor */ 76002b15e34STodd Poynor map_write(map, CMD(0xb0), adr); 76102b15e34STodd Poynor usec -= xip_elapsed_since(start); 76202b15e34STodd Poynor suspended = xip_currtime(); 76302b15e34STodd Poynor do { 76402b15e34STodd Poynor if (xip_elapsed_since(suspended) > 100000) { 76502b15e34STodd Poynor /* 76602b15e34STodd Poynor * The chip doesn't want to suspend 76702b15e34STodd Poynor * after waiting for 100 msecs. 76802b15e34STodd Poynor * This is a critical error but there 76902b15e34STodd Poynor * is not much we can do here. 77002b15e34STodd Poynor */ 77102b15e34STodd Poynor return; 77202b15e34STodd Poynor } 77302b15e34STodd Poynor status = map_read(map, adr); 77402b15e34STodd Poynor } while (!map_word_andequal(map, status, OK, OK)); 77502b15e34STodd Poynor 77602b15e34STodd Poynor /* Suspend succeeded */ 77702b15e34STodd Poynor oldstate = chip->state; 77802b15e34STodd Poynor if (!map_word_bitsset(map, status, CMD(0x40))) 77902b15e34STodd Poynor break; 78002b15e34STodd Poynor chip->state = FL_XIP_WHILE_ERASING; 78102b15e34STodd Poynor chip->erase_suspended = 1; 78202b15e34STodd Poynor map_write(map, CMD(0xf0), adr); 78302b15e34STodd Poynor (void) map_read(map, adr); 784ca5c23c3SPaulius Zaleckas xip_iprefetch(); 78502b15e34STodd Poynor local_irq_enable(); 786c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 787ca5c23c3SPaulius Zaleckas xip_iprefetch(); 78802b15e34STodd Poynor cond_resched(); 78902b15e34STodd Poynor 79002b15e34STodd Poynor /* 79102b15e34STodd Poynor * We're back. However someone else might have 79202b15e34STodd Poynor * decided to go write to the chip if we are in 79302b15e34STodd Poynor * a suspended erase state. If so let's wait 79402b15e34STodd Poynor * until it's done. 79502b15e34STodd Poynor */ 796c4e77376SStefani Seibold mutex_lock(&chip->mutex); 79702b15e34STodd Poynor while (chip->state != FL_XIP_WHILE_ERASING) { 79802b15e34STodd Poynor DECLARE_WAITQUEUE(wait, current); 79902b15e34STodd Poynor set_current_state(TASK_UNINTERRUPTIBLE); 80002b15e34STodd Poynor add_wait_queue(&chip->wq, &wait); 801c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 80202b15e34STodd Poynor schedule(); 80302b15e34STodd Poynor remove_wait_queue(&chip->wq, &wait); 804c4e77376SStefani Seibold mutex_lock(&chip->mutex); 80502b15e34STodd Poynor } 80602b15e34STodd Poynor /* Disallow XIP again */ 80702b15e34STodd Poynor local_irq_disable(); 80802b15e34STodd Poynor 80902b15e34STodd Poynor /* Resume the write or erase operation */ 81002b15e34STodd Poynor map_write(map, CMD(0x30), adr); 81102b15e34STodd Poynor chip->state = oldstate; 81202b15e34STodd Poynor start = xip_currtime(); 81302b15e34STodd Poynor } else if (usec >= 1000000/HZ) { 81402b15e34STodd Poynor /* 81502b15e34STodd Poynor * Try to save on CPU power when waiting delay 81602b15e34STodd Poynor * is at least a system timer tick period. 81702b15e34STodd Poynor * No need to be extremely accurate here. 81802b15e34STodd Poynor */ 81902b15e34STodd Poynor xip_cpu_idle(); 82002b15e34STodd Poynor } 82102b15e34STodd Poynor status = map_read(map, adr); 82202b15e34STodd Poynor } while (!map_word_andequal(map, status, OK, OK) 82302b15e34STodd Poynor && xip_elapsed_since(start) < usec); 82402b15e34STodd Poynor } 82502b15e34STodd Poynor 82602b15e34STodd Poynor #define UDELAY(map, chip, adr, usec) xip_udelay(map, chip, adr, usec) 82702b15e34STodd Poynor 82802b15e34STodd Poynor /* 82902b15e34STodd Poynor * The INVALIDATE_CACHED_RANGE() macro is normally used in parallel while 83002b15e34STodd Poynor * the flash is actively programming or erasing since we have to poll for 83102b15e34STodd Poynor * the operation to complete anyway. We can't do that in a generic way with 83202b15e34STodd Poynor * a XIP setup so do it before the actual flash operation in this case 83302b15e34STodd Poynor * and stub it out from INVALIDATE_CACHE_UDELAY. 83402b15e34STodd Poynor */ 83502b15e34STodd Poynor #define XIP_INVAL_CACHED_RANGE(map, from, size) \ 83602b15e34STodd Poynor INVALIDATE_CACHED_RANGE(map, from, size) 83702b15e34STodd Poynor 83802b15e34STodd Poynor #define INVALIDATE_CACHE_UDELAY(map, chip, adr, len, usec) \ 83902b15e34STodd Poynor UDELAY(map, chip, adr, usec) 84002b15e34STodd Poynor 84102b15e34STodd Poynor /* 84202b15e34STodd Poynor * Extra notes: 84302b15e34STodd Poynor * 84402b15e34STodd Poynor * Activating this XIP support changes the way the code works a bit. For 84502b15e34STodd Poynor * example the code to suspend the current process when concurrent access 84602b15e34STodd Poynor * happens is never executed because xip_udelay() will always return with the 84702b15e34STodd Poynor * same chip state as it was entered with. This is why there is no care for 84802b15e34STodd Poynor * the presence of add_wait_queue() or schedule() calls from within a couple 84902b15e34STodd Poynor * xip_disable()'d areas of code, like in do_erase_oneblock for example. 85002b15e34STodd Poynor * The queueing and scheduling are always happening within xip_udelay(). 85102b15e34STodd Poynor * 85202b15e34STodd Poynor * Similarly, get_chip() and put_chip() just happen to always be executed 85302b15e34STodd Poynor * with chip->state set to FL_READY (or FL_XIP_WHILE_*) where flash state 85402b15e34STodd Poynor * is in array mode, therefore never executing many cases therein and not 85502b15e34STodd Poynor * causing any problem with XIP. 85602b15e34STodd Poynor */ 85702b15e34STodd Poynor 85802b15e34STodd Poynor #else 85902b15e34STodd Poynor 86002b15e34STodd Poynor #define xip_disable(map, chip, adr) 86102b15e34STodd Poynor #define xip_enable(map, chip, adr) 86202b15e34STodd Poynor #define XIP_INVAL_CACHED_RANGE(x...) 86302b15e34STodd Poynor 86402b15e34STodd Poynor #define UDELAY(map, chip, adr, usec) \ 86502b15e34STodd Poynor do { \ 866c4e77376SStefani Seibold mutex_unlock(&chip->mutex); \ 86702b15e34STodd Poynor cfi_udelay(usec); \ 868c4e77376SStefani Seibold mutex_lock(&chip->mutex); \ 86902b15e34STodd Poynor } while (0) 87002b15e34STodd Poynor 87102b15e34STodd Poynor #define INVALIDATE_CACHE_UDELAY(map, chip, adr, len, usec) \ 87202b15e34STodd Poynor do { \ 873c4e77376SStefani Seibold mutex_unlock(&chip->mutex); \ 87402b15e34STodd Poynor INVALIDATE_CACHED_RANGE(map, adr, len); \ 87502b15e34STodd Poynor cfi_udelay(usec); \ 876c4e77376SStefani Seibold mutex_lock(&chip->mutex); \ 87702b15e34STodd Poynor } while (0) 87802b15e34STodd Poynor 87902b15e34STodd Poynor #endif 8801da177e4SLinus Torvalds 8811da177e4SLinus Torvalds static inline int do_read_onechip(struct map_info *map, struct flchip *chip, loff_t adr, size_t len, u_char *buf) 8821da177e4SLinus Torvalds { 8831da177e4SLinus Torvalds unsigned long cmd_addr; 8841da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 8851da177e4SLinus Torvalds int ret; 8861da177e4SLinus Torvalds 8871da177e4SLinus Torvalds adr += chip->start; 8881da177e4SLinus Torvalds 8891da177e4SLinus Torvalds /* Ensure cmd read/writes are aligned. */ 8901da177e4SLinus Torvalds cmd_addr = adr & ~(map_bankwidth(map)-1); 8911da177e4SLinus Torvalds 892c4e77376SStefani Seibold mutex_lock(&chip->mutex); 8931da177e4SLinus Torvalds ret = get_chip(map, chip, cmd_addr, FL_READY); 8941da177e4SLinus Torvalds if (ret) { 895c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 8961da177e4SLinus Torvalds return ret; 8971da177e4SLinus Torvalds } 8981da177e4SLinus Torvalds 8991da177e4SLinus Torvalds if (chip->state != FL_POINT && chip->state != FL_READY) { 9001da177e4SLinus Torvalds map_write(map, CMD(0xf0), cmd_addr); 9011da177e4SLinus Torvalds chip->state = FL_READY; 9021da177e4SLinus Torvalds } 9031da177e4SLinus Torvalds 9041da177e4SLinus Torvalds map_copy_from(map, buf, adr, len); 9051da177e4SLinus Torvalds 9061da177e4SLinus Torvalds put_chip(map, chip, cmd_addr); 9071da177e4SLinus Torvalds 908c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 9091da177e4SLinus Torvalds return 0; 9101da177e4SLinus Torvalds } 9111da177e4SLinus Torvalds 9121da177e4SLinus Torvalds 9131da177e4SLinus Torvalds static int cfi_amdstd_read (struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf) 9141da177e4SLinus Torvalds { 9151da177e4SLinus Torvalds struct map_info *map = mtd->priv; 9161da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 9171da177e4SLinus Torvalds unsigned long ofs; 9181da177e4SLinus Torvalds int chipnum; 9191da177e4SLinus Torvalds int ret = 0; 9201da177e4SLinus Torvalds 9211da177e4SLinus Torvalds /* ofs: offset within the first chip that the first read should start */ 9221da177e4SLinus Torvalds 9231da177e4SLinus Torvalds chipnum = (from >> cfi->chipshift); 9241da177e4SLinus Torvalds ofs = from - (chipnum << cfi->chipshift); 9251da177e4SLinus Torvalds 9261da177e4SLinus Torvalds 9271da177e4SLinus Torvalds *retlen = 0; 9281da177e4SLinus Torvalds 9291da177e4SLinus Torvalds while (len) { 9301da177e4SLinus Torvalds unsigned long thislen; 9311da177e4SLinus Torvalds 9321da177e4SLinus Torvalds if (chipnum >= cfi->numchips) 9331da177e4SLinus Torvalds break; 9341da177e4SLinus Torvalds 9351da177e4SLinus Torvalds if ((len + ofs -1) >> cfi->chipshift) 9361da177e4SLinus Torvalds thislen = (1<<cfi->chipshift) - ofs; 9371da177e4SLinus Torvalds else 9381da177e4SLinus Torvalds thislen = len; 9391da177e4SLinus Torvalds 9401da177e4SLinus Torvalds ret = do_read_onechip(map, &cfi->chips[chipnum], ofs, thislen, buf); 9411da177e4SLinus Torvalds if (ret) 9421da177e4SLinus Torvalds break; 9431da177e4SLinus Torvalds 9441da177e4SLinus Torvalds *retlen += thislen; 9451da177e4SLinus Torvalds len -= thislen; 9461da177e4SLinus Torvalds buf += thislen; 9471da177e4SLinus Torvalds 9481da177e4SLinus Torvalds ofs = 0; 9491da177e4SLinus Torvalds chipnum++; 9501da177e4SLinus Torvalds } 9511da177e4SLinus Torvalds return ret; 9521da177e4SLinus Torvalds } 9531da177e4SLinus Torvalds 9541da177e4SLinus Torvalds 9551da177e4SLinus Torvalds static inline int do_read_secsi_onechip(struct map_info *map, struct flchip *chip, loff_t adr, size_t len, u_char *buf) 9561da177e4SLinus Torvalds { 9571da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 9581da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 9591da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 9601da177e4SLinus Torvalds 9611da177e4SLinus Torvalds retry: 962c4e77376SStefani Seibold mutex_lock(&chip->mutex); 9631da177e4SLinus Torvalds 9641da177e4SLinus Torvalds if (chip->state != FL_READY){ 9651da177e4SLinus Torvalds #if 0 9661da177e4SLinus Torvalds printk(KERN_DEBUG "Waiting for chip to read, status = %d\n", chip->state); 9671da177e4SLinus Torvalds #endif 9681da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 9691da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 9701da177e4SLinus Torvalds 971c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 9721da177e4SLinus Torvalds 9731da177e4SLinus Torvalds schedule(); 9741da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 9751da177e4SLinus Torvalds #if 0 9761da177e4SLinus Torvalds if(signal_pending(current)) 9771da177e4SLinus Torvalds return -EINTR; 9781da177e4SLinus Torvalds #endif 9791da177e4SLinus Torvalds timeo = jiffies + HZ; 9801da177e4SLinus Torvalds 9811da177e4SLinus Torvalds goto retry; 9821da177e4SLinus Torvalds } 9831da177e4SLinus Torvalds 9841da177e4SLinus Torvalds adr += chip->start; 9851da177e4SLinus Torvalds 9861da177e4SLinus Torvalds chip->state = FL_READY; 9871da177e4SLinus Torvalds 9881da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 9891da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 9901da177e4SLinus Torvalds cfi_send_gen_cmd(0x88, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 9911da177e4SLinus Torvalds 9921da177e4SLinus Torvalds map_copy_from(map, buf, adr, len); 9931da177e4SLinus Torvalds 9941da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 9951da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 9961da177e4SLinus Torvalds cfi_send_gen_cmd(0x90, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 9971da177e4SLinus Torvalds cfi_send_gen_cmd(0x00, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 9981da177e4SLinus Torvalds 9991da177e4SLinus Torvalds wake_up(&chip->wq); 1000c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 10011da177e4SLinus Torvalds 10021da177e4SLinus Torvalds return 0; 10031da177e4SLinus Torvalds } 10041da177e4SLinus Torvalds 10051da177e4SLinus Torvalds static int cfi_amdstd_secsi_read (struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf) 10061da177e4SLinus Torvalds { 10071da177e4SLinus Torvalds struct map_info *map = mtd->priv; 10081da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 10091da177e4SLinus Torvalds unsigned long ofs; 10101da177e4SLinus Torvalds int chipnum; 10111da177e4SLinus Torvalds int ret = 0; 10121da177e4SLinus Torvalds 10131da177e4SLinus Torvalds 10141da177e4SLinus Torvalds /* ofs: offset within the first chip that the first read should start */ 10151da177e4SLinus Torvalds 10161da177e4SLinus Torvalds /* 8 secsi bytes per chip */ 10171da177e4SLinus Torvalds chipnum=from>>3; 10181da177e4SLinus Torvalds ofs=from & 7; 10191da177e4SLinus Torvalds 10201da177e4SLinus Torvalds 10211da177e4SLinus Torvalds *retlen = 0; 10221da177e4SLinus Torvalds 10231da177e4SLinus Torvalds while (len) { 10241da177e4SLinus Torvalds unsigned long thislen; 10251da177e4SLinus Torvalds 10261da177e4SLinus Torvalds if (chipnum >= cfi->numchips) 10271da177e4SLinus Torvalds break; 10281da177e4SLinus Torvalds 10291da177e4SLinus Torvalds if ((len + ofs -1) >> 3) 10301da177e4SLinus Torvalds thislen = (1<<3) - ofs; 10311da177e4SLinus Torvalds else 10321da177e4SLinus Torvalds thislen = len; 10331da177e4SLinus Torvalds 10341da177e4SLinus Torvalds ret = do_read_secsi_onechip(map, &cfi->chips[chipnum], ofs, thislen, buf); 10351da177e4SLinus Torvalds if (ret) 10361da177e4SLinus Torvalds break; 10371da177e4SLinus Torvalds 10381da177e4SLinus Torvalds *retlen += thislen; 10391da177e4SLinus Torvalds len -= thislen; 10401da177e4SLinus Torvalds buf += thislen; 10411da177e4SLinus Torvalds 10421da177e4SLinus Torvalds ofs = 0; 10431da177e4SLinus Torvalds chipnum++; 10441da177e4SLinus Torvalds } 10451da177e4SLinus Torvalds return ret; 10461da177e4SLinus Torvalds } 10471da177e4SLinus Torvalds 10481da177e4SLinus Torvalds 104902b15e34STodd Poynor static int __xipram do_write_oneword(struct map_info *map, struct flchip *chip, unsigned long adr, map_word datum) 10501da177e4SLinus Torvalds { 10511da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 10521da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 10531da177e4SLinus Torvalds /* 10541da177e4SLinus Torvalds * We use a 1ms + 1 jiffies generic timeout for writes (most devices 10551da177e4SLinus Torvalds * have a max write time of a few hundreds usec). However, we should 10561da177e4SLinus Torvalds * use the maximum timeout value given by the chip at probe time 10571da177e4SLinus Torvalds * instead. Unfortunately, struct flchip does have a field for 10581da177e4SLinus Torvalds * maximum timeout, only for typical which can be far too short 10591da177e4SLinus Torvalds * depending of the conditions. The ' + 1' is to avoid having a 10601da177e4SLinus Torvalds * timeout of 0 jiffies if HZ is smaller than 1000. 10611da177e4SLinus Torvalds */ 10621da177e4SLinus Torvalds unsigned long uWriteTimeout = ( HZ / 1000 ) + 1; 10631da177e4SLinus Torvalds int ret = 0; 10641da177e4SLinus Torvalds map_word oldd; 10651da177e4SLinus Torvalds int retry_cnt = 0; 10661da177e4SLinus Torvalds 10671da177e4SLinus Torvalds adr += chip->start; 10681da177e4SLinus Torvalds 1069c4e77376SStefani Seibold mutex_lock(&chip->mutex); 10701da177e4SLinus Torvalds ret = get_chip(map, chip, adr, FL_WRITING); 10711da177e4SLinus Torvalds if (ret) { 1072c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 10731da177e4SLinus Torvalds return ret; 10741da177e4SLinus Torvalds } 10751da177e4SLinus Torvalds 10761da177e4SLinus Torvalds DEBUG( MTD_DEBUG_LEVEL3, "MTD %s(): WRITE 0x%.8lx(0x%.8lx)\n", 10771da177e4SLinus Torvalds __func__, adr, datum.x[0] ); 10781da177e4SLinus Torvalds 10791da177e4SLinus Torvalds /* 10801da177e4SLinus Torvalds * Check for a NOP for the case when the datum to write is already 10811da177e4SLinus Torvalds * present - it saves time and works around buggy chips that corrupt 10821da177e4SLinus Torvalds * data at other locations when 0xff is written to a location that 10831da177e4SLinus Torvalds * already contains 0xff. 10841da177e4SLinus Torvalds */ 10851da177e4SLinus Torvalds oldd = map_read(map, adr); 10861da177e4SLinus Torvalds if (map_word_equal(map, oldd, datum)) { 10871da177e4SLinus Torvalds DEBUG( MTD_DEBUG_LEVEL3, "MTD %s(): NOP\n", 10881da177e4SLinus Torvalds __func__); 10891da177e4SLinus Torvalds goto op_done; 10901da177e4SLinus Torvalds } 10911da177e4SLinus Torvalds 109202b15e34STodd Poynor XIP_INVAL_CACHED_RANGE(map, adr, map_bankwidth(map)); 10931da177e4SLinus Torvalds ENABLE_VPP(map); 109402b15e34STodd Poynor xip_disable(map, chip, adr); 10951da177e4SLinus Torvalds retry: 10961da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 10971da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 10981da177e4SLinus Torvalds cfi_send_gen_cmd(0xA0, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 10991da177e4SLinus Torvalds map_write(map, datum, adr); 11001da177e4SLinus Torvalds chip->state = FL_WRITING; 11011da177e4SLinus Torvalds 110202b15e34STodd Poynor INVALIDATE_CACHE_UDELAY(map, chip, 110302b15e34STodd Poynor adr, map_bankwidth(map), 110402b15e34STodd Poynor chip->word_write_time); 11051da177e4SLinus Torvalds 11061da177e4SLinus Torvalds /* See comment above for timeout value. */ 11071da177e4SLinus Torvalds timeo = jiffies + uWriteTimeout; 11081da177e4SLinus Torvalds for (;;) { 11091da177e4SLinus Torvalds if (chip->state != FL_WRITING) { 11101da177e4SLinus Torvalds /* Someone's suspended the write. Sleep */ 11111da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 11121da177e4SLinus Torvalds 11131da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 11141da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 1115c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 11161da177e4SLinus Torvalds schedule(); 11171da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 11181da177e4SLinus Torvalds timeo = jiffies + (HZ / 2); /* FIXME */ 1119c4e77376SStefani Seibold mutex_lock(&chip->mutex); 11201da177e4SLinus Torvalds continue; 11211da177e4SLinus Torvalds } 11221da177e4SLinus Torvalds 1123b95f9609SKonstantin Baidarov if (time_after(jiffies, timeo) && !chip_ready(map, adr)){ 112402b15e34STodd Poynor xip_enable(map, chip, adr); 1125fb4a90bfSEric W. Biedermann printk(KERN_WARNING "MTD %s(): software timeout\n", __func__); 112602b15e34STodd Poynor xip_disable(map, chip, adr); 1127fb4a90bfSEric W. Biedermann break; 1128fb4a90bfSEric W. Biedermann } 1129fb4a90bfSEric W. Biedermann 1130b95f9609SKonstantin Baidarov if (chip_ready(map, adr)) 1131b95f9609SKonstantin Baidarov break; 1132b95f9609SKonstantin Baidarov 11331da177e4SLinus Torvalds /* Latency issues. Drop the lock, wait a while and retry */ 113402b15e34STodd Poynor UDELAY(map, chip, adr, 1); 11351da177e4SLinus Torvalds } 1136fb4a90bfSEric W. Biedermann /* Did we succeed? */ 1137fb4a90bfSEric W. Biedermann if (!chip_good(map, adr, datum)) { 11381da177e4SLinus Torvalds /* reset on all failures. */ 11391da177e4SLinus Torvalds map_write( map, CMD(0xF0), chip->start ); 11401da177e4SLinus Torvalds /* FIXME - should have reset delay before continuing */ 1141fb4a90bfSEric W. Biedermann 11421da177e4SLinus Torvalds if (++retry_cnt <= MAX_WORD_RETRIES) 11431da177e4SLinus Torvalds goto retry; 11441da177e4SLinus Torvalds 11451da177e4SLinus Torvalds ret = -EIO; 1146fb4a90bfSEric W. Biedermann } 114702b15e34STodd Poynor xip_enable(map, chip, adr); 11481da177e4SLinus Torvalds op_done: 11491da177e4SLinus Torvalds chip->state = FL_READY; 11501da177e4SLinus Torvalds put_chip(map, chip, adr); 1151c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 11521da177e4SLinus Torvalds 11531da177e4SLinus Torvalds return ret; 11541da177e4SLinus Torvalds } 11551da177e4SLinus Torvalds 11561da177e4SLinus Torvalds 11571da177e4SLinus Torvalds static int cfi_amdstd_write_words(struct mtd_info *mtd, loff_t to, size_t len, 11581da177e4SLinus Torvalds size_t *retlen, const u_char *buf) 11591da177e4SLinus Torvalds { 11601da177e4SLinus Torvalds struct map_info *map = mtd->priv; 11611da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 11621da177e4SLinus Torvalds int ret = 0; 11631da177e4SLinus Torvalds int chipnum; 11641da177e4SLinus Torvalds unsigned long ofs, chipstart; 11651da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 11661da177e4SLinus Torvalds 11671da177e4SLinus Torvalds *retlen = 0; 11681da177e4SLinus Torvalds if (!len) 11691da177e4SLinus Torvalds return 0; 11701da177e4SLinus Torvalds 11711da177e4SLinus Torvalds chipnum = to >> cfi->chipshift; 11721da177e4SLinus Torvalds ofs = to - (chipnum << cfi->chipshift); 11731da177e4SLinus Torvalds chipstart = cfi->chips[chipnum].start; 11741da177e4SLinus Torvalds 11751da177e4SLinus Torvalds /* If it's not bus-aligned, do the first byte write */ 11761da177e4SLinus Torvalds if (ofs & (map_bankwidth(map)-1)) { 11771da177e4SLinus Torvalds unsigned long bus_ofs = ofs & ~(map_bankwidth(map)-1); 11781da177e4SLinus Torvalds int i = ofs - bus_ofs; 11791da177e4SLinus Torvalds int n = 0; 11801da177e4SLinus Torvalds map_word tmp_buf; 11811da177e4SLinus Torvalds 11821da177e4SLinus Torvalds retry: 1183c4e77376SStefani Seibold mutex_lock(&cfi->chips[chipnum].mutex); 11841da177e4SLinus Torvalds 11851da177e4SLinus Torvalds if (cfi->chips[chipnum].state != FL_READY) { 11861da177e4SLinus Torvalds #if 0 11871da177e4SLinus Torvalds printk(KERN_DEBUG "Waiting for chip to write, status = %d\n", cfi->chips[chipnum].state); 11881da177e4SLinus Torvalds #endif 11891da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 11901da177e4SLinus Torvalds add_wait_queue(&cfi->chips[chipnum].wq, &wait); 11911da177e4SLinus Torvalds 1192c4e77376SStefani Seibold mutex_unlock(&cfi->chips[chipnum].mutex); 11931da177e4SLinus Torvalds 11941da177e4SLinus Torvalds schedule(); 11951da177e4SLinus Torvalds remove_wait_queue(&cfi->chips[chipnum].wq, &wait); 11961da177e4SLinus Torvalds #if 0 11971da177e4SLinus Torvalds if(signal_pending(current)) 11981da177e4SLinus Torvalds return -EINTR; 11991da177e4SLinus Torvalds #endif 12001da177e4SLinus Torvalds goto retry; 12011da177e4SLinus Torvalds } 12021da177e4SLinus Torvalds 12031da177e4SLinus Torvalds /* Load 'tmp_buf' with old contents of flash */ 12041da177e4SLinus Torvalds tmp_buf = map_read(map, bus_ofs+chipstart); 12051da177e4SLinus Torvalds 1206c4e77376SStefani Seibold mutex_unlock(&cfi->chips[chipnum].mutex); 12071da177e4SLinus Torvalds 12081da177e4SLinus Torvalds /* Number of bytes to copy from buffer */ 12091da177e4SLinus Torvalds n = min_t(int, len, map_bankwidth(map)-i); 12101da177e4SLinus Torvalds 12111da177e4SLinus Torvalds tmp_buf = map_word_load_partial(map, tmp_buf, buf, i, n); 12121da177e4SLinus Torvalds 12131da177e4SLinus Torvalds ret = do_write_oneword(map, &cfi->chips[chipnum], 12141da177e4SLinus Torvalds bus_ofs, tmp_buf); 12151da177e4SLinus Torvalds if (ret) 12161da177e4SLinus Torvalds return ret; 12171da177e4SLinus Torvalds 12181da177e4SLinus Torvalds ofs += n; 12191da177e4SLinus Torvalds buf += n; 12201da177e4SLinus Torvalds (*retlen) += n; 12211da177e4SLinus Torvalds len -= n; 12221da177e4SLinus Torvalds 12231da177e4SLinus Torvalds if (ofs >> cfi->chipshift) { 12241da177e4SLinus Torvalds chipnum ++; 12251da177e4SLinus Torvalds ofs = 0; 12261da177e4SLinus Torvalds if (chipnum == cfi->numchips) 12271da177e4SLinus Torvalds return 0; 12281da177e4SLinus Torvalds } 12291da177e4SLinus Torvalds } 12301da177e4SLinus Torvalds 12311da177e4SLinus Torvalds /* We are now aligned, write as much as possible */ 12321da177e4SLinus Torvalds while(len >= map_bankwidth(map)) { 12331da177e4SLinus Torvalds map_word datum; 12341da177e4SLinus Torvalds 12351da177e4SLinus Torvalds datum = map_word_load(map, buf); 12361da177e4SLinus Torvalds 12371da177e4SLinus Torvalds ret = do_write_oneword(map, &cfi->chips[chipnum], 12381da177e4SLinus Torvalds ofs, datum); 12391da177e4SLinus Torvalds if (ret) 12401da177e4SLinus Torvalds return ret; 12411da177e4SLinus Torvalds 12421da177e4SLinus Torvalds ofs += map_bankwidth(map); 12431da177e4SLinus Torvalds buf += map_bankwidth(map); 12441da177e4SLinus Torvalds (*retlen) += map_bankwidth(map); 12451da177e4SLinus Torvalds len -= map_bankwidth(map); 12461da177e4SLinus Torvalds 12471da177e4SLinus Torvalds if (ofs >> cfi->chipshift) { 12481da177e4SLinus Torvalds chipnum ++; 12491da177e4SLinus Torvalds ofs = 0; 12501da177e4SLinus Torvalds if (chipnum == cfi->numchips) 12511da177e4SLinus Torvalds return 0; 12521da177e4SLinus Torvalds chipstart = cfi->chips[chipnum].start; 12531da177e4SLinus Torvalds } 12541da177e4SLinus Torvalds } 12551da177e4SLinus Torvalds 12561da177e4SLinus Torvalds /* Write the trailing bytes if any */ 12571da177e4SLinus Torvalds if (len & (map_bankwidth(map)-1)) { 12581da177e4SLinus Torvalds map_word tmp_buf; 12591da177e4SLinus Torvalds 12601da177e4SLinus Torvalds retry1: 1261c4e77376SStefani Seibold mutex_lock(&cfi->chips[chipnum].mutex); 12621da177e4SLinus Torvalds 12631da177e4SLinus Torvalds if (cfi->chips[chipnum].state != FL_READY) { 12641da177e4SLinus Torvalds #if 0 12651da177e4SLinus Torvalds printk(KERN_DEBUG "Waiting for chip to write, status = %d\n", cfi->chips[chipnum].state); 12661da177e4SLinus Torvalds #endif 12671da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 12681da177e4SLinus Torvalds add_wait_queue(&cfi->chips[chipnum].wq, &wait); 12691da177e4SLinus Torvalds 1270c4e77376SStefani Seibold mutex_unlock(&cfi->chips[chipnum].mutex); 12711da177e4SLinus Torvalds 12721da177e4SLinus Torvalds schedule(); 12731da177e4SLinus Torvalds remove_wait_queue(&cfi->chips[chipnum].wq, &wait); 12741da177e4SLinus Torvalds #if 0 12751da177e4SLinus Torvalds if(signal_pending(current)) 12761da177e4SLinus Torvalds return -EINTR; 12771da177e4SLinus Torvalds #endif 12781da177e4SLinus Torvalds goto retry1; 12791da177e4SLinus Torvalds } 12801da177e4SLinus Torvalds 12811da177e4SLinus Torvalds tmp_buf = map_read(map, ofs + chipstart); 12821da177e4SLinus Torvalds 1283c4e77376SStefani Seibold mutex_unlock(&cfi->chips[chipnum].mutex); 12841da177e4SLinus Torvalds 12851da177e4SLinus Torvalds tmp_buf = map_word_load_partial(map, tmp_buf, buf, 0, len); 12861da177e4SLinus Torvalds 12871da177e4SLinus Torvalds ret = do_write_oneword(map, &cfi->chips[chipnum], 12881da177e4SLinus Torvalds ofs, tmp_buf); 12891da177e4SLinus Torvalds if (ret) 12901da177e4SLinus Torvalds return ret; 12911da177e4SLinus Torvalds 12921da177e4SLinus Torvalds (*retlen) += len; 12931da177e4SLinus Torvalds } 12941da177e4SLinus Torvalds 12951da177e4SLinus Torvalds return 0; 12961da177e4SLinus Torvalds } 12971da177e4SLinus Torvalds 12981da177e4SLinus Torvalds 12991da177e4SLinus Torvalds /* 13001da177e4SLinus Torvalds * FIXME: interleaved mode not tested, and probably not supported! 13011da177e4SLinus Torvalds */ 130202b15e34STodd Poynor static int __xipram do_write_buffer(struct map_info *map, struct flchip *chip, 130302b15e34STodd Poynor unsigned long adr, const u_char *buf, 130402b15e34STodd Poynor int len) 13051da177e4SLinus Torvalds { 13061da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 13071da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 13081da177e4SLinus Torvalds /* see comments in do_write_oneword() regarding uWriteTimeo. */ 13091da177e4SLinus Torvalds unsigned long uWriteTimeout = ( HZ / 1000 ) + 1; 13101da177e4SLinus Torvalds int ret = -EIO; 13111da177e4SLinus Torvalds unsigned long cmd_adr; 13121da177e4SLinus Torvalds int z, words; 13131da177e4SLinus Torvalds map_word datum; 13141da177e4SLinus Torvalds 13151da177e4SLinus Torvalds adr += chip->start; 13161da177e4SLinus Torvalds cmd_adr = adr; 13171da177e4SLinus Torvalds 1318c4e77376SStefani Seibold mutex_lock(&chip->mutex); 13191da177e4SLinus Torvalds ret = get_chip(map, chip, adr, FL_WRITING); 13201da177e4SLinus Torvalds if (ret) { 1321c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 13221da177e4SLinus Torvalds return ret; 13231da177e4SLinus Torvalds } 13241da177e4SLinus Torvalds 13251da177e4SLinus Torvalds datum = map_word_load(map, buf); 13261da177e4SLinus Torvalds 13271da177e4SLinus Torvalds DEBUG( MTD_DEBUG_LEVEL3, "MTD %s(): WRITE 0x%.8lx(0x%.8lx)\n", 13281da177e4SLinus Torvalds __func__, adr, datum.x[0] ); 13291da177e4SLinus Torvalds 133002b15e34STodd Poynor XIP_INVAL_CACHED_RANGE(map, adr, len); 13311da177e4SLinus Torvalds ENABLE_VPP(map); 133202b15e34STodd Poynor xip_disable(map, chip, cmd_adr); 133302b15e34STodd Poynor 13341da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 13351da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 13361da177e4SLinus Torvalds //cfi_send_gen_cmd(0xA0, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 13371da177e4SLinus Torvalds 13381da177e4SLinus Torvalds /* Write Buffer Load */ 13391da177e4SLinus Torvalds map_write(map, CMD(0x25), cmd_adr); 13401da177e4SLinus Torvalds 13411da177e4SLinus Torvalds chip->state = FL_WRITING_TO_BUFFER; 13421da177e4SLinus Torvalds 13431da177e4SLinus Torvalds /* Write length of data to come */ 13441da177e4SLinus Torvalds words = len / map_bankwidth(map); 13451da177e4SLinus Torvalds map_write(map, CMD(words - 1), cmd_adr); 13461da177e4SLinus Torvalds /* Write data */ 13471da177e4SLinus Torvalds z = 0; 13481da177e4SLinus Torvalds while(z < words * map_bankwidth(map)) { 13491da177e4SLinus Torvalds datum = map_word_load(map, buf); 13501da177e4SLinus Torvalds map_write(map, datum, adr + z); 13511da177e4SLinus Torvalds 13521da177e4SLinus Torvalds z += map_bankwidth(map); 13531da177e4SLinus Torvalds buf += map_bankwidth(map); 13541da177e4SLinus Torvalds } 13551da177e4SLinus Torvalds z -= map_bankwidth(map); 13561da177e4SLinus Torvalds 13571da177e4SLinus Torvalds adr += z; 13581da177e4SLinus Torvalds 13591da177e4SLinus Torvalds /* Write Buffer Program Confirm: GO GO GO */ 13601da177e4SLinus Torvalds map_write(map, CMD(0x29), cmd_adr); 13611da177e4SLinus Torvalds chip->state = FL_WRITING; 13621da177e4SLinus Torvalds 136302b15e34STodd Poynor INVALIDATE_CACHE_UDELAY(map, chip, 136402b15e34STodd Poynor adr, map_bankwidth(map), 136502b15e34STodd Poynor chip->word_write_time); 13661da177e4SLinus Torvalds 13671da177e4SLinus Torvalds timeo = jiffies + uWriteTimeout; 13681da177e4SLinus Torvalds 13691da177e4SLinus Torvalds for (;;) { 13701da177e4SLinus Torvalds if (chip->state != FL_WRITING) { 13711da177e4SLinus Torvalds /* Someone's suspended the write. Sleep */ 13721da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 13731da177e4SLinus Torvalds 13741da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 13751da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 1376c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 13771da177e4SLinus Torvalds schedule(); 13781da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 13791da177e4SLinus Torvalds timeo = jiffies + (HZ / 2); /* FIXME */ 1380c4e77376SStefani Seibold mutex_lock(&chip->mutex); 13811da177e4SLinus Torvalds continue; 13821da177e4SLinus Torvalds } 13831da177e4SLinus Torvalds 1384b95f9609SKonstantin Baidarov if (time_after(jiffies, timeo) && !chip_ready(map, adr)) 1385b95f9609SKonstantin Baidarov break; 1386b95f9609SKonstantin Baidarov 138702b15e34STodd Poynor if (chip_ready(map, adr)) { 138802b15e34STodd Poynor xip_enable(map, chip, adr); 13891da177e4SLinus Torvalds goto op_done; 139002b15e34STodd Poynor } 13911da177e4SLinus Torvalds 13921da177e4SLinus Torvalds /* Latency issues. Drop the lock, wait a while and retry */ 139302b15e34STodd Poynor UDELAY(map, chip, adr, 1); 13941da177e4SLinus Torvalds } 13951da177e4SLinus Torvalds 13961da177e4SLinus Torvalds /* reset on all failures. */ 13971da177e4SLinus Torvalds map_write( map, CMD(0xF0), chip->start ); 139802b15e34STodd Poynor xip_enable(map, chip, adr); 13991da177e4SLinus Torvalds /* FIXME - should have reset delay before continuing */ 14001da177e4SLinus Torvalds 140102b15e34STodd Poynor printk(KERN_WARNING "MTD %s(): software timeout\n", 140202b15e34STodd Poynor __func__ ); 140302b15e34STodd Poynor 14041da177e4SLinus Torvalds ret = -EIO; 14051da177e4SLinus Torvalds op_done: 14061da177e4SLinus Torvalds chip->state = FL_READY; 14071da177e4SLinus Torvalds put_chip(map, chip, adr); 1408c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 14091da177e4SLinus Torvalds 14101da177e4SLinus Torvalds return ret; 14111da177e4SLinus Torvalds } 14121da177e4SLinus Torvalds 14131da177e4SLinus Torvalds 14141da177e4SLinus Torvalds static int cfi_amdstd_write_buffers(struct mtd_info *mtd, loff_t to, size_t len, 14151da177e4SLinus Torvalds size_t *retlen, const u_char *buf) 14161da177e4SLinus Torvalds { 14171da177e4SLinus Torvalds struct map_info *map = mtd->priv; 14181da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 14191da177e4SLinus Torvalds int wbufsize = cfi_interleave(cfi) << cfi->cfiq->MaxBufWriteSize; 14201da177e4SLinus Torvalds int ret = 0; 14211da177e4SLinus Torvalds int chipnum; 14221da177e4SLinus Torvalds unsigned long ofs; 14231da177e4SLinus Torvalds 14241da177e4SLinus Torvalds *retlen = 0; 14251da177e4SLinus Torvalds if (!len) 14261da177e4SLinus Torvalds return 0; 14271da177e4SLinus Torvalds 14281da177e4SLinus Torvalds chipnum = to >> cfi->chipshift; 14291da177e4SLinus Torvalds ofs = to - (chipnum << cfi->chipshift); 14301da177e4SLinus Torvalds 14311da177e4SLinus Torvalds /* If it's not bus-aligned, do the first word write */ 14321da177e4SLinus Torvalds if (ofs & (map_bankwidth(map)-1)) { 14331da177e4SLinus Torvalds size_t local_len = (-ofs)&(map_bankwidth(map)-1); 14341da177e4SLinus Torvalds if (local_len > len) 14351da177e4SLinus Torvalds local_len = len; 14361da177e4SLinus Torvalds ret = cfi_amdstd_write_words(mtd, ofs + (chipnum<<cfi->chipshift), 14371da177e4SLinus Torvalds local_len, retlen, buf); 14381da177e4SLinus Torvalds if (ret) 14391da177e4SLinus Torvalds return ret; 14401da177e4SLinus Torvalds ofs += local_len; 14411da177e4SLinus Torvalds buf += local_len; 14421da177e4SLinus Torvalds len -= local_len; 14431da177e4SLinus Torvalds 14441da177e4SLinus Torvalds if (ofs >> cfi->chipshift) { 14451da177e4SLinus Torvalds chipnum ++; 14461da177e4SLinus Torvalds ofs = 0; 14471da177e4SLinus Torvalds if (chipnum == cfi->numchips) 14481da177e4SLinus Torvalds return 0; 14491da177e4SLinus Torvalds } 14501da177e4SLinus Torvalds } 14511da177e4SLinus Torvalds 14521da177e4SLinus Torvalds /* Write buffer is worth it only if more than one word to write... */ 14531da177e4SLinus Torvalds while (len >= map_bankwidth(map) * 2) { 14541da177e4SLinus Torvalds /* We must not cross write block boundaries */ 14551da177e4SLinus Torvalds int size = wbufsize - (ofs & (wbufsize-1)); 14561da177e4SLinus Torvalds 14571da177e4SLinus Torvalds if (size > len) 14581da177e4SLinus Torvalds size = len; 14591da177e4SLinus Torvalds if (size % map_bankwidth(map)) 14601da177e4SLinus Torvalds size -= size % map_bankwidth(map); 14611da177e4SLinus Torvalds 14621da177e4SLinus Torvalds ret = do_write_buffer(map, &cfi->chips[chipnum], 14631da177e4SLinus Torvalds ofs, buf, size); 14641da177e4SLinus Torvalds if (ret) 14651da177e4SLinus Torvalds return ret; 14661da177e4SLinus Torvalds 14671da177e4SLinus Torvalds ofs += size; 14681da177e4SLinus Torvalds buf += size; 14691da177e4SLinus Torvalds (*retlen) += size; 14701da177e4SLinus Torvalds len -= size; 14711da177e4SLinus Torvalds 14721da177e4SLinus Torvalds if (ofs >> cfi->chipshift) { 14731da177e4SLinus Torvalds chipnum ++; 14741da177e4SLinus Torvalds ofs = 0; 14751da177e4SLinus Torvalds if (chipnum == cfi->numchips) 14761da177e4SLinus Torvalds return 0; 14771da177e4SLinus Torvalds } 14781da177e4SLinus Torvalds } 14791da177e4SLinus Torvalds 14801da177e4SLinus Torvalds if (len) { 14811da177e4SLinus Torvalds size_t retlen_dregs = 0; 14821da177e4SLinus Torvalds 14831da177e4SLinus Torvalds ret = cfi_amdstd_write_words(mtd, ofs + (chipnum<<cfi->chipshift), 14841da177e4SLinus Torvalds len, &retlen_dregs, buf); 14851da177e4SLinus Torvalds 14861da177e4SLinus Torvalds *retlen += retlen_dregs; 14871da177e4SLinus Torvalds return ret; 14881da177e4SLinus Torvalds } 14891da177e4SLinus Torvalds 14901da177e4SLinus Torvalds return 0; 14911da177e4SLinus Torvalds } 14921da177e4SLinus Torvalds 14931da177e4SLinus Torvalds 14941da177e4SLinus Torvalds /* 14951da177e4SLinus Torvalds * Handle devices with one erase region, that only implement 14961da177e4SLinus Torvalds * the chip erase command. 14971da177e4SLinus Torvalds */ 149802b15e34STodd Poynor static int __xipram do_erase_chip(struct map_info *map, struct flchip *chip) 14991da177e4SLinus Torvalds { 15001da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 15011da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 15021da177e4SLinus Torvalds unsigned long int adr; 15031da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 15041da177e4SLinus Torvalds int ret = 0; 15051da177e4SLinus Torvalds 15061da177e4SLinus Torvalds adr = cfi->addr_unlock1; 15071da177e4SLinus Torvalds 1508c4e77376SStefani Seibold mutex_lock(&chip->mutex); 15091da177e4SLinus Torvalds ret = get_chip(map, chip, adr, FL_WRITING); 15101da177e4SLinus Torvalds if (ret) { 1511c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 15121da177e4SLinus Torvalds return ret; 15131da177e4SLinus Torvalds } 15141da177e4SLinus Torvalds 15151da177e4SLinus Torvalds DEBUG( MTD_DEBUG_LEVEL3, "MTD %s(): ERASE 0x%.8lx\n", 15161da177e4SLinus Torvalds __func__, chip->start ); 15171da177e4SLinus Torvalds 151802b15e34STodd Poynor XIP_INVAL_CACHED_RANGE(map, adr, map->size); 15191da177e4SLinus Torvalds ENABLE_VPP(map); 152002b15e34STodd Poynor xip_disable(map, chip, adr); 152102b15e34STodd Poynor 15221da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 15231da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 15241da177e4SLinus Torvalds cfi_send_gen_cmd(0x80, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 15251da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 15261da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 15271da177e4SLinus Torvalds cfi_send_gen_cmd(0x10, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 15281da177e4SLinus Torvalds 15291da177e4SLinus Torvalds chip->state = FL_ERASING; 15301da177e4SLinus Torvalds chip->erase_suspended = 0; 15311da177e4SLinus Torvalds chip->in_progress_block_addr = adr; 15321da177e4SLinus Torvalds 153302b15e34STodd Poynor INVALIDATE_CACHE_UDELAY(map, chip, 153402b15e34STodd Poynor adr, map->size, 153502b15e34STodd Poynor chip->erase_time*500); 15361da177e4SLinus Torvalds 15371da177e4SLinus Torvalds timeo = jiffies + (HZ*20); 15381da177e4SLinus Torvalds 15391da177e4SLinus Torvalds for (;;) { 15401da177e4SLinus Torvalds if (chip->state != FL_ERASING) { 15411da177e4SLinus Torvalds /* Someone's suspended the erase. Sleep */ 15421da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 15431da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 1544c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 15451da177e4SLinus Torvalds schedule(); 15461da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 1547c4e77376SStefani Seibold mutex_lock(&chip->mutex); 15481da177e4SLinus Torvalds continue; 15491da177e4SLinus Torvalds } 15501da177e4SLinus Torvalds if (chip->erase_suspended) { 15511da177e4SLinus Torvalds /* This erase was suspended and resumed. 15521da177e4SLinus Torvalds Adjust the timeout */ 15531da177e4SLinus Torvalds timeo = jiffies + (HZ*20); /* FIXME */ 15541da177e4SLinus Torvalds chip->erase_suspended = 0; 15551da177e4SLinus Torvalds } 15561da177e4SLinus Torvalds 15571da177e4SLinus Torvalds if (chip_ready(map, adr)) 15581da177e4SLinus Torvalds break; 15591da177e4SLinus Torvalds 1560fb4a90bfSEric W. Biedermann if (time_after(jiffies, timeo)) { 1561fb4a90bfSEric W. Biedermann printk(KERN_WARNING "MTD %s(): software timeout\n", 1562fb4a90bfSEric W. Biedermann __func__ ); 1563fb4a90bfSEric W. Biedermann break; 1564fb4a90bfSEric W. Biedermann } 1565fb4a90bfSEric W. Biedermann 15661da177e4SLinus Torvalds /* Latency issues. Drop the lock, wait a while and retry */ 156702b15e34STodd Poynor UDELAY(map, chip, adr, 1000000/HZ); 15681da177e4SLinus Torvalds } 1569fb4a90bfSEric W. Biedermann /* Did we succeed? */ 1570fb4a90bfSEric W. Biedermann if (!chip_good(map, adr, map_word_ff(map))) { 15711da177e4SLinus Torvalds /* reset on all failures. */ 15721da177e4SLinus Torvalds map_write( map, CMD(0xF0), chip->start ); 15731da177e4SLinus Torvalds /* FIXME - should have reset delay before continuing */ 15741da177e4SLinus Torvalds 15751da177e4SLinus Torvalds ret = -EIO; 1576fb4a90bfSEric W. Biedermann } 1577fb4a90bfSEric W. Biedermann 15781da177e4SLinus Torvalds chip->state = FL_READY; 157902b15e34STodd Poynor xip_enable(map, chip, adr); 15801da177e4SLinus Torvalds put_chip(map, chip, adr); 1581c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 15821da177e4SLinus Torvalds 15831da177e4SLinus Torvalds return ret; 15841da177e4SLinus Torvalds } 15851da177e4SLinus Torvalds 15861da177e4SLinus Torvalds 158702b15e34STodd Poynor static int __xipram do_erase_oneblock(struct map_info *map, struct flchip *chip, unsigned long adr, int len, void *thunk) 15881da177e4SLinus Torvalds { 15891da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 15901da177e4SLinus Torvalds unsigned long timeo = jiffies + HZ; 15911da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 15921da177e4SLinus Torvalds int ret = 0; 15931da177e4SLinus Torvalds 15941da177e4SLinus Torvalds adr += chip->start; 15951da177e4SLinus Torvalds 1596c4e77376SStefani Seibold mutex_lock(&chip->mutex); 15971da177e4SLinus Torvalds ret = get_chip(map, chip, adr, FL_ERASING); 15981da177e4SLinus Torvalds if (ret) { 1599c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 16001da177e4SLinus Torvalds return ret; 16011da177e4SLinus Torvalds } 16021da177e4SLinus Torvalds 16031da177e4SLinus Torvalds DEBUG( MTD_DEBUG_LEVEL3, "MTD %s(): ERASE 0x%.8lx\n", 16041da177e4SLinus Torvalds __func__, adr ); 16051da177e4SLinus Torvalds 160602b15e34STodd Poynor XIP_INVAL_CACHED_RANGE(map, adr, len); 16071da177e4SLinus Torvalds ENABLE_VPP(map); 160802b15e34STodd Poynor xip_disable(map, chip, adr); 160902b15e34STodd Poynor 16101da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 16111da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 16121da177e4SLinus Torvalds cfi_send_gen_cmd(0x80, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 16131da177e4SLinus Torvalds cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, cfi->device_type, NULL); 16141da177e4SLinus Torvalds cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, cfi->device_type, NULL); 16151da177e4SLinus Torvalds map_write(map, CMD(0x30), adr); 16161da177e4SLinus Torvalds 16171da177e4SLinus Torvalds chip->state = FL_ERASING; 16181da177e4SLinus Torvalds chip->erase_suspended = 0; 16191da177e4SLinus Torvalds chip->in_progress_block_addr = adr; 16201da177e4SLinus Torvalds 162102b15e34STodd Poynor INVALIDATE_CACHE_UDELAY(map, chip, 162202b15e34STodd Poynor adr, len, 162302b15e34STodd Poynor chip->erase_time*500); 16241da177e4SLinus Torvalds 16251da177e4SLinus Torvalds timeo = jiffies + (HZ*20); 16261da177e4SLinus Torvalds 16271da177e4SLinus Torvalds for (;;) { 16281da177e4SLinus Torvalds if (chip->state != FL_ERASING) { 16291da177e4SLinus Torvalds /* Someone's suspended the erase. Sleep */ 16301da177e4SLinus Torvalds set_current_state(TASK_UNINTERRUPTIBLE); 16311da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 1632c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 16331da177e4SLinus Torvalds schedule(); 16341da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 1635c4e77376SStefani Seibold mutex_lock(&chip->mutex); 16361da177e4SLinus Torvalds continue; 16371da177e4SLinus Torvalds } 16381da177e4SLinus Torvalds if (chip->erase_suspended) { 16391da177e4SLinus Torvalds /* This erase was suspended and resumed. 16401da177e4SLinus Torvalds Adjust the timeout */ 16411da177e4SLinus Torvalds timeo = jiffies + (HZ*20); /* FIXME */ 16421da177e4SLinus Torvalds chip->erase_suspended = 0; 16431da177e4SLinus Torvalds } 16441da177e4SLinus Torvalds 164502b15e34STodd Poynor if (chip_ready(map, adr)) { 164602b15e34STodd Poynor xip_enable(map, chip, adr); 16471da177e4SLinus Torvalds break; 164802b15e34STodd Poynor } 16491da177e4SLinus Torvalds 1650fb4a90bfSEric W. Biedermann if (time_after(jiffies, timeo)) { 165102b15e34STodd Poynor xip_enable(map, chip, adr); 1652fb4a90bfSEric W. Biedermann printk(KERN_WARNING "MTD %s(): software timeout\n", 1653fb4a90bfSEric W. Biedermann __func__ ); 1654fb4a90bfSEric W. Biedermann break; 1655fb4a90bfSEric W. Biedermann } 1656fb4a90bfSEric W. Biedermann 16571da177e4SLinus Torvalds /* Latency issues. Drop the lock, wait a while and retry */ 165802b15e34STodd Poynor UDELAY(map, chip, adr, 1000000/HZ); 16591da177e4SLinus Torvalds } 1660fb4a90bfSEric W. Biedermann /* Did we succeed? */ 166122fd9a87SThomas Gleixner if (!chip_good(map, adr, map_word_ff(map))) { 16621da177e4SLinus Torvalds /* reset on all failures. */ 16631da177e4SLinus Torvalds map_write( map, CMD(0xF0), chip->start ); 16641da177e4SLinus Torvalds /* FIXME - should have reset delay before continuing */ 16651da177e4SLinus Torvalds 16661da177e4SLinus Torvalds ret = -EIO; 1667fb4a90bfSEric W. Biedermann } 1668fb4a90bfSEric W. Biedermann 16691da177e4SLinus Torvalds chip->state = FL_READY; 16701da177e4SLinus Torvalds put_chip(map, chip, adr); 1671c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 16721da177e4SLinus Torvalds return ret; 16731da177e4SLinus Torvalds } 16741da177e4SLinus Torvalds 16751da177e4SLinus Torvalds 1676ce0f33adSBen Dooks static int cfi_amdstd_erase_varsize(struct mtd_info *mtd, struct erase_info *instr) 16771da177e4SLinus Torvalds { 16781da177e4SLinus Torvalds unsigned long ofs, len; 16791da177e4SLinus Torvalds int ret; 16801da177e4SLinus Torvalds 16811da177e4SLinus Torvalds ofs = instr->addr; 16821da177e4SLinus Torvalds len = instr->len; 16831da177e4SLinus Torvalds 16841da177e4SLinus Torvalds ret = cfi_varsize_frob(mtd, do_erase_oneblock, ofs, len, NULL); 16851da177e4SLinus Torvalds if (ret) 16861da177e4SLinus Torvalds return ret; 16871da177e4SLinus Torvalds 16881da177e4SLinus Torvalds instr->state = MTD_ERASE_DONE; 16891da177e4SLinus Torvalds mtd_erase_callback(instr); 16901da177e4SLinus Torvalds 16911da177e4SLinus Torvalds return 0; 16921da177e4SLinus Torvalds } 16931da177e4SLinus Torvalds 16941da177e4SLinus Torvalds 16951da177e4SLinus Torvalds static int cfi_amdstd_erase_chip(struct mtd_info *mtd, struct erase_info *instr) 16961da177e4SLinus Torvalds { 16971da177e4SLinus Torvalds struct map_info *map = mtd->priv; 16981da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 16991da177e4SLinus Torvalds int ret = 0; 17001da177e4SLinus Torvalds 17011da177e4SLinus Torvalds if (instr->addr != 0) 17021da177e4SLinus Torvalds return -EINVAL; 17031da177e4SLinus Torvalds 17041da177e4SLinus Torvalds if (instr->len != mtd->size) 17051da177e4SLinus Torvalds return -EINVAL; 17061da177e4SLinus Torvalds 17071da177e4SLinus Torvalds ret = do_erase_chip(map, &cfi->chips[0]); 17081da177e4SLinus Torvalds if (ret) 17091da177e4SLinus Torvalds return ret; 17101da177e4SLinus Torvalds 17111da177e4SLinus Torvalds instr->state = MTD_ERASE_DONE; 17121da177e4SLinus Torvalds mtd_erase_callback(instr); 17131da177e4SLinus Torvalds 17141da177e4SLinus Torvalds return 0; 17151da177e4SLinus Torvalds } 17161da177e4SLinus Torvalds 17170165508cSHaavard Skinnemoen static int do_atmel_lock(struct map_info *map, struct flchip *chip, 17180165508cSHaavard Skinnemoen unsigned long adr, int len, void *thunk) 17190165508cSHaavard Skinnemoen { 17200165508cSHaavard Skinnemoen struct cfi_private *cfi = map->fldrv_priv; 17210165508cSHaavard Skinnemoen int ret; 17220165508cSHaavard Skinnemoen 1723c4e77376SStefani Seibold mutex_lock(&chip->mutex); 17240165508cSHaavard Skinnemoen ret = get_chip(map, chip, adr + chip->start, FL_LOCKING); 17250165508cSHaavard Skinnemoen if (ret) 17260165508cSHaavard Skinnemoen goto out_unlock; 17270165508cSHaavard Skinnemoen chip->state = FL_LOCKING; 17280165508cSHaavard Skinnemoen 17290165508cSHaavard Skinnemoen DEBUG(MTD_DEBUG_LEVEL3, "MTD %s(): LOCK 0x%08lx len %d\n", 17300165508cSHaavard Skinnemoen __func__, adr, len); 17310165508cSHaavard Skinnemoen 17320165508cSHaavard Skinnemoen cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, 17330165508cSHaavard Skinnemoen cfi->device_type, NULL); 17340165508cSHaavard Skinnemoen cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, 17350165508cSHaavard Skinnemoen cfi->device_type, NULL); 17360165508cSHaavard Skinnemoen cfi_send_gen_cmd(0x80, cfi->addr_unlock1, chip->start, map, cfi, 17370165508cSHaavard Skinnemoen cfi->device_type, NULL); 17380165508cSHaavard Skinnemoen cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, 17390165508cSHaavard Skinnemoen cfi->device_type, NULL); 17400165508cSHaavard Skinnemoen cfi_send_gen_cmd(0x55, cfi->addr_unlock2, chip->start, map, cfi, 17410165508cSHaavard Skinnemoen cfi->device_type, NULL); 17420165508cSHaavard Skinnemoen map_write(map, CMD(0x40), chip->start + adr); 17430165508cSHaavard Skinnemoen 17440165508cSHaavard Skinnemoen chip->state = FL_READY; 17450165508cSHaavard Skinnemoen put_chip(map, chip, adr + chip->start); 17460165508cSHaavard Skinnemoen ret = 0; 17470165508cSHaavard Skinnemoen 17480165508cSHaavard Skinnemoen out_unlock: 1749c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 17500165508cSHaavard Skinnemoen return ret; 17510165508cSHaavard Skinnemoen } 17520165508cSHaavard Skinnemoen 17530165508cSHaavard Skinnemoen static int do_atmel_unlock(struct map_info *map, struct flchip *chip, 17540165508cSHaavard Skinnemoen unsigned long adr, int len, void *thunk) 17550165508cSHaavard Skinnemoen { 17560165508cSHaavard Skinnemoen struct cfi_private *cfi = map->fldrv_priv; 17570165508cSHaavard Skinnemoen int ret; 17580165508cSHaavard Skinnemoen 1759c4e77376SStefani Seibold mutex_lock(&chip->mutex); 17600165508cSHaavard Skinnemoen ret = get_chip(map, chip, adr + chip->start, FL_UNLOCKING); 17610165508cSHaavard Skinnemoen if (ret) 17620165508cSHaavard Skinnemoen goto out_unlock; 17630165508cSHaavard Skinnemoen chip->state = FL_UNLOCKING; 17640165508cSHaavard Skinnemoen 17650165508cSHaavard Skinnemoen DEBUG(MTD_DEBUG_LEVEL3, "MTD %s(): LOCK 0x%08lx len %d\n", 17660165508cSHaavard Skinnemoen __func__, adr, len); 17670165508cSHaavard Skinnemoen 17680165508cSHaavard Skinnemoen cfi_send_gen_cmd(0xAA, cfi->addr_unlock1, chip->start, map, cfi, 17690165508cSHaavard Skinnemoen cfi->device_type, NULL); 17700165508cSHaavard Skinnemoen map_write(map, CMD(0x70), adr); 17710165508cSHaavard Skinnemoen 17720165508cSHaavard Skinnemoen chip->state = FL_READY; 17730165508cSHaavard Skinnemoen put_chip(map, chip, adr + chip->start); 17740165508cSHaavard Skinnemoen ret = 0; 17750165508cSHaavard Skinnemoen 17760165508cSHaavard Skinnemoen out_unlock: 1777c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 17780165508cSHaavard Skinnemoen return ret; 17790165508cSHaavard Skinnemoen } 17800165508cSHaavard Skinnemoen 178169423d99SAdrian Hunter static int cfi_atmel_lock(struct mtd_info *mtd, loff_t ofs, uint64_t len) 17820165508cSHaavard Skinnemoen { 17830165508cSHaavard Skinnemoen return cfi_varsize_frob(mtd, do_atmel_lock, ofs, len, NULL); 17840165508cSHaavard Skinnemoen } 17850165508cSHaavard Skinnemoen 178669423d99SAdrian Hunter static int cfi_atmel_unlock(struct mtd_info *mtd, loff_t ofs, uint64_t len) 17870165508cSHaavard Skinnemoen { 17880165508cSHaavard Skinnemoen return cfi_varsize_frob(mtd, do_atmel_unlock, ofs, len, NULL); 17890165508cSHaavard Skinnemoen } 17900165508cSHaavard Skinnemoen 17911da177e4SLinus Torvalds 17921da177e4SLinus Torvalds static void cfi_amdstd_sync (struct mtd_info *mtd) 17931da177e4SLinus Torvalds { 17941da177e4SLinus Torvalds struct map_info *map = mtd->priv; 17951da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 17961da177e4SLinus Torvalds int i; 17971da177e4SLinus Torvalds struct flchip *chip; 17981da177e4SLinus Torvalds int ret = 0; 17991da177e4SLinus Torvalds DECLARE_WAITQUEUE(wait, current); 18001da177e4SLinus Torvalds 18011da177e4SLinus Torvalds for (i=0; !ret && i<cfi->numchips; i++) { 18021da177e4SLinus Torvalds chip = &cfi->chips[i]; 18031da177e4SLinus Torvalds 18041da177e4SLinus Torvalds retry: 1805c4e77376SStefani Seibold mutex_lock(&chip->mutex); 18061da177e4SLinus Torvalds 18071da177e4SLinus Torvalds switch(chip->state) { 18081da177e4SLinus Torvalds case FL_READY: 18091da177e4SLinus Torvalds case FL_STATUS: 18101da177e4SLinus Torvalds case FL_CFI_QUERY: 18111da177e4SLinus Torvalds case FL_JEDEC_QUERY: 18121da177e4SLinus Torvalds chip->oldstate = chip->state; 18131da177e4SLinus Torvalds chip->state = FL_SYNCING; 18141da177e4SLinus Torvalds /* No need to wake_up() on this state change - 18151da177e4SLinus Torvalds * as the whole point is that nobody can do anything 18161da177e4SLinus Torvalds * with the chip now anyway. 18171da177e4SLinus Torvalds */ 18181da177e4SLinus Torvalds case FL_SYNCING: 1819c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 18201da177e4SLinus Torvalds break; 18211da177e4SLinus Torvalds 18221da177e4SLinus Torvalds default: 18231da177e4SLinus Torvalds /* Not an idle state */ 1824f8e30e44SDmitry Adamushko set_current_state(TASK_UNINTERRUPTIBLE); 18251da177e4SLinus Torvalds add_wait_queue(&chip->wq, &wait); 18261da177e4SLinus Torvalds 1827c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 18281da177e4SLinus Torvalds 18291da177e4SLinus Torvalds schedule(); 18301da177e4SLinus Torvalds 18311da177e4SLinus Torvalds remove_wait_queue(&chip->wq, &wait); 18321da177e4SLinus Torvalds 18331da177e4SLinus Torvalds goto retry; 18341da177e4SLinus Torvalds } 18351da177e4SLinus Torvalds } 18361da177e4SLinus Torvalds 18371da177e4SLinus Torvalds /* Unlock the chips again */ 18381da177e4SLinus Torvalds 18391da177e4SLinus Torvalds for (i--; i >=0; i--) { 18401da177e4SLinus Torvalds chip = &cfi->chips[i]; 18411da177e4SLinus Torvalds 1842c4e77376SStefani Seibold mutex_lock(&chip->mutex); 18431da177e4SLinus Torvalds 18441da177e4SLinus Torvalds if (chip->state == FL_SYNCING) { 18451da177e4SLinus Torvalds chip->state = chip->oldstate; 18461da177e4SLinus Torvalds wake_up(&chip->wq); 18471da177e4SLinus Torvalds } 1848c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 18491da177e4SLinus Torvalds } 18501da177e4SLinus Torvalds } 18511da177e4SLinus Torvalds 18521da177e4SLinus Torvalds 18531da177e4SLinus Torvalds static int cfi_amdstd_suspend(struct mtd_info *mtd) 18541da177e4SLinus Torvalds { 18551da177e4SLinus Torvalds struct map_info *map = mtd->priv; 18561da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 18571da177e4SLinus Torvalds int i; 18581da177e4SLinus Torvalds struct flchip *chip; 18591da177e4SLinus Torvalds int ret = 0; 18601da177e4SLinus Torvalds 18611da177e4SLinus Torvalds for (i=0; !ret && i<cfi->numchips; i++) { 18621da177e4SLinus Torvalds chip = &cfi->chips[i]; 18631da177e4SLinus Torvalds 1864c4e77376SStefani Seibold mutex_lock(&chip->mutex); 18651da177e4SLinus Torvalds 18661da177e4SLinus Torvalds switch(chip->state) { 18671da177e4SLinus Torvalds case FL_READY: 18681da177e4SLinus Torvalds case FL_STATUS: 18691da177e4SLinus Torvalds case FL_CFI_QUERY: 18701da177e4SLinus Torvalds case FL_JEDEC_QUERY: 18711da177e4SLinus Torvalds chip->oldstate = chip->state; 18721da177e4SLinus Torvalds chip->state = FL_PM_SUSPENDED; 18731da177e4SLinus Torvalds /* No need to wake_up() on this state change - 18741da177e4SLinus Torvalds * as the whole point is that nobody can do anything 18751da177e4SLinus Torvalds * with the chip now anyway. 18761da177e4SLinus Torvalds */ 18771da177e4SLinus Torvalds case FL_PM_SUSPENDED: 18781da177e4SLinus Torvalds break; 18791da177e4SLinus Torvalds 18801da177e4SLinus Torvalds default: 18811da177e4SLinus Torvalds ret = -EAGAIN; 18821da177e4SLinus Torvalds break; 18831da177e4SLinus Torvalds } 1884c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 18851da177e4SLinus Torvalds } 18861da177e4SLinus Torvalds 18871da177e4SLinus Torvalds /* Unlock the chips again */ 18881da177e4SLinus Torvalds 18891da177e4SLinus Torvalds if (ret) { 18901da177e4SLinus Torvalds for (i--; i >=0; i--) { 18911da177e4SLinus Torvalds chip = &cfi->chips[i]; 18921da177e4SLinus Torvalds 1893c4e77376SStefani Seibold mutex_lock(&chip->mutex); 18941da177e4SLinus Torvalds 18951da177e4SLinus Torvalds if (chip->state == FL_PM_SUSPENDED) { 18961da177e4SLinus Torvalds chip->state = chip->oldstate; 18971da177e4SLinus Torvalds wake_up(&chip->wq); 18981da177e4SLinus Torvalds } 1899c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 19001da177e4SLinus Torvalds } 19011da177e4SLinus Torvalds } 19021da177e4SLinus Torvalds 19031da177e4SLinus Torvalds return ret; 19041da177e4SLinus Torvalds } 19051da177e4SLinus Torvalds 19061da177e4SLinus Torvalds 19071da177e4SLinus Torvalds static void cfi_amdstd_resume(struct mtd_info *mtd) 19081da177e4SLinus Torvalds { 19091da177e4SLinus Torvalds struct map_info *map = mtd->priv; 19101da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 19111da177e4SLinus Torvalds int i; 19121da177e4SLinus Torvalds struct flchip *chip; 19131da177e4SLinus Torvalds 19141da177e4SLinus Torvalds for (i=0; i<cfi->numchips; i++) { 19151da177e4SLinus Torvalds 19161da177e4SLinus Torvalds chip = &cfi->chips[i]; 19171da177e4SLinus Torvalds 1918c4e77376SStefani Seibold mutex_lock(&chip->mutex); 19191da177e4SLinus Torvalds 19201da177e4SLinus Torvalds if (chip->state == FL_PM_SUSPENDED) { 19211da177e4SLinus Torvalds chip->state = FL_READY; 19221da177e4SLinus Torvalds map_write(map, CMD(0xF0), chip->start); 19231da177e4SLinus Torvalds wake_up(&chip->wq); 19241da177e4SLinus Torvalds } 19251da177e4SLinus Torvalds else 19261da177e4SLinus Torvalds printk(KERN_ERR "Argh. Chip not in PM_SUSPENDED state upon resume()\n"); 19271da177e4SLinus Torvalds 1928c4e77376SStefani Seibold mutex_unlock(&chip->mutex); 19291da177e4SLinus Torvalds } 19301da177e4SLinus Torvalds } 19311da177e4SLinus Torvalds 1932eafe1311SKevin Cernekee 1933eafe1311SKevin Cernekee /* 1934eafe1311SKevin Cernekee * Ensure that the flash device is put back into read array mode before 1935eafe1311SKevin Cernekee * unloading the driver or rebooting. On some systems, rebooting while 1936eafe1311SKevin Cernekee * the flash is in query/program/erase mode will prevent the CPU from 1937eafe1311SKevin Cernekee * fetching the bootloader code, requiring a hard reset or power cycle. 1938eafe1311SKevin Cernekee */ 1939eafe1311SKevin Cernekee static int cfi_amdstd_reset(struct mtd_info *mtd) 1940eafe1311SKevin Cernekee { 1941eafe1311SKevin Cernekee struct map_info *map = mtd->priv; 1942eafe1311SKevin Cernekee struct cfi_private *cfi = map->fldrv_priv; 1943eafe1311SKevin Cernekee int i, ret; 1944eafe1311SKevin Cernekee struct flchip *chip; 1945eafe1311SKevin Cernekee 1946eafe1311SKevin Cernekee for (i = 0; i < cfi->numchips; i++) { 1947eafe1311SKevin Cernekee 1948eafe1311SKevin Cernekee chip = &cfi->chips[i]; 1949eafe1311SKevin Cernekee 1950eafe1311SKevin Cernekee mutex_lock(&chip->mutex); 1951eafe1311SKevin Cernekee 1952eafe1311SKevin Cernekee ret = get_chip(map, chip, chip->start, FL_SHUTDOWN); 1953eafe1311SKevin Cernekee if (!ret) { 1954eafe1311SKevin Cernekee map_write(map, CMD(0xF0), chip->start); 1955eafe1311SKevin Cernekee chip->state = FL_SHUTDOWN; 1956eafe1311SKevin Cernekee put_chip(map, chip, chip->start); 1957eafe1311SKevin Cernekee } 1958eafe1311SKevin Cernekee 1959eafe1311SKevin Cernekee mutex_unlock(&chip->mutex); 1960eafe1311SKevin Cernekee } 1961eafe1311SKevin Cernekee 1962eafe1311SKevin Cernekee return 0; 1963eafe1311SKevin Cernekee } 1964eafe1311SKevin Cernekee 1965eafe1311SKevin Cernekee 1966eafe1311SKevin Cernekee static int cfi_amdstd_reboot(struct notifier_block *nb, unsigned long val, 1967eafe1311SKevin Cernekee void *v) 1968eafe1311SKevin Cernekee { 1969eafe1311SKevin Cernekee struct mtd_info *mtd; 1970eafe1311SKevin Cernekee 1971eafe1311SKevin Cernekee mtd = container_of(nb, struct mtd_info, reboot_notifier); 1972eafe1311SKevin Cernekee cfi_amdstd_reset(mtd); 1973eafe1311SKevin Cernekee return NOTIFY_DONE; 1974eafe1311SKevin Cernekee } 1975eafe1311SKevin Cernekee 1976eafe1311SKevin Cernekee 19771da177e4SLinus Torvalds static void cfi_amdstd_destroy(struct mtd_info *mtd) 19781da177e4SLinus Torvalds { 19791da177e4SLinus Torvalds struct map_info *map = mtd->priv; 19801da177e4SLinus Torvalds struct cfi_private *cfi = map->fldrv_priv; 1981fa671646SJesper Juhl 1982eafe1311SKevin Cernekee cfi_amdstd_reset(mtd); 1983eafe1311SKevin Cernekee unregister_reboot_notifier(&mtd->reboot_notifier); 19841da177e4SLinus Torvalds kfree(cfi->cmdset_priv); 19851da177e4SLinus Torvalds kfree(cfi->cfiq); 19861da177e4SLinus Torvalds kfree(cfi); 19871da177e4SLinus Torvalds kfree(mtd->eraseregions); 19881da177e4SLinus Torvalds } 19891da177e4SLinus Torvalds 19901da177e4SLinus Torvalds MODULE_LICENSE("GPL"); 19911da177e4SLinus Torvalds MODULE_AUTHOR("Crossnet Co. <info@crossnet.co.jp> et al."); 19921da177e4SLinus Torvalds MODULE_DESCRIPTION("MTD chip driver for AMD/Fujitsu flash chips"); 1993