vserver 1.9.5.x5
[linux-2.6.git] / drivers / mtd / chips / cfi_probe.c
index fba4ddf..cf75003 100644 (file)
@@ -1,7 +1,7 @@
 /* 
    Common Flash Interface probe code.
    (C) 2000 Red Hat. GPL'd.
-   $Id: cfi_probe.c,v 1.71 2003/05/28 12:51:48 dwmw2 Exp $
+   $Id: cfi_probe.c,v 1.83 2004/11/16 18:19:02 nico Exp $
 */
 
 #include <linux/config.h>
@@ -15,6 +15,7 @@
 #include <linux/slab.h>
 #include <linux/interrupt.h>
 
+#include <linux/mtd/xip.h>
 #include <linux/mtd/map.h>
 #include <linux/mtd/cfi.h>
 #include <linux/mtd/gen_probe.h>
@@ -26,30 +27,80 @@ static void print_cfi_ident(struct cfi_ident *);
 #endif
 
 static int cfi_probe_chip(struct map_info *map, __u32 base,
-                         struct flchip *chips, struct cfi_private *cfi);
+                         unsigned long *chip_map, struct cfi_private *cfi);
 static int cfi_chip_setup(struct map_info *map, struct cfi_private *cfi);
 
 struct mtd_info *cfi_probe(struct map_info *map);
 
+#ifdef CONFIG_MTD_XIP
+
+/* only needed for short periods, so this is rather simple */
+#define xip_disable()  local_irq_disable()
+
+#define xip_allowed(base, map) \
+do { \
+       (void) map_read(map, base); \
+       asm volatile (".rep 8; nop; .endr"); \
+       local_irq_enable(); \
+} while (0)
+
+#define xip_enable(base, map, cfi) \
+do { \
+       cfi_send_gen_cmd(0xF0, 0, base, map, cfi, cfi->device_type, NULL); \
+       cfi_send_gen_cmd(0xFF, 0, base, map, cfi, cfi->device_type, NULL); \
+       xip_allowed(base, map); \
+} while (0)
+
+#define xip_disable_qry(base, map, cfi) \
+do { \
+       xip_disable(); \
+       cfi_send_gen_cmd(0xF0, 0, base, map, cfi, cfi->device_type, NULL); \
+       cfi_send_gen_cmd(0xFF, 0, base, map, cfi, cfi->device_type, NULL); \
+       cfi_send_gen_cmd(0x98, 0x55, base, map, cfi, cfi->device_type, NULL); \
+} while (0)
+
+#else
+
+#define xip_disable()                  do { } while (0)
+#define xip_allowed(base, map)         do { } while (0)
+#define xip_enable(base, map, cfi)     do { } while (0)
+#define xip_disable_qry(base, map, cfi) do { } while (0)
+
+#endif
+
 /* check for QRY.
    in: interleave,type,mode
    ret: table index, <0 for error
  */
-static inline int qry_present(struct map_info *map, __u32 base,
+static int __xipram qry_present(struct map_info *map, __u32 base,
                                struct cfi_private *cfi)
 {
        int osf = cfi->interleave * cfi->device_type;   // scale factor
+       map_word val[3];
+       map_word qry[3];
 
-       if (cfi_read(map,base+osf*0x10)==cfi_build_cmd('Q',map,cfi) &&
-           cfi_read(map,base+osf*0x11)==cfi_build_cmd('R',map,cfi) &&
-           cfi_read(map,base+osf*0x12)==cfi_build_cmd('Y',map,cfi))
-               return 1;       // ok !
+       qry[0] = cfi_build_cmd('Q', map, cfi);
+       qry[1] = cfi_build_cmd('R', map, cfi);
+       qry[2] = cfi_build_cmd('Y', map, cfi);
 
-       return 0;       // nothing found
+       val[0] = map_read(map, base + osf*0x10);
+       val[1] = map_read(map, base + osf*0x11);
+       val[2] = map_read(map, base + osf*0x12);
+
+       if (!map_word_equal(map, qry[0], val[0]))
+               return 0;
+
+       if (!map_word_equal(map, qry[1], val[1]))
+               return 0;
+
+       if (!map_word_equal(map, qry[2], val[2]))
+               return 0;
+
+       return 1;       // "QRY" found
 }
 
-static int cfi_probe_chip(struct map_info *map, __u32 base,
-                         struct flchip *chips, struct cfi_private *cfi)
+static int __xipram cfi_probe_chip(struct map_info *map, __u32 base,
+                                  unsigned long *chip_map, struct cfi_private *cfi)
 {
        int i;
        
@@ -65,11 +116,16 @@ static int cfi_probe_chip(struct map_info *map, __u32 base,
                        (unsigned long)base + 0x55, map->size -1);
                return 0;
        }
+
+       xip_disable();
        cfi_send_gen_cmd(0xF0, 0, base, map, cfi, cfi->device_type, NULL);
+       cfi_send_gen_cmd(0xFF, 0, base, map, cfi, cfi->device_type, NULL);
        cfi_send_gen_cmd(0x98, 0x55, base, map, cfi, cfi->device_type, NULL);
 
-       if (!qry_present(map,base,cfi))
+       if (!qry_present(map,base,cfi)) {
+               xip_enable(base, map, cfi);
                return 0;
+       }
 
        if (!cfi->numchips) {
                /* This is the first time we're called. Set up the CFI 
@@ -78,18 +134,26 @@ static int cfi_probe_chip(struct map_info *map, __u32 base,
        }
 
        /* Check each previous chip to see if it's an alias */
-       for (i=0; i<cfi->numchips; i++) {
+       for (i=0; i < (base >> cfi->chipshift); i++) {
+               unsigned long start;
+               if(!test_bit(i, chip_map)) {
+                       /* Skip location; no valid chip at this address */
+                       continue; 
+               }
+               start = i << cfi->chipshift;
                /* This chip should be in read mode if it's one
                   we've already touched. */
-               if (qry_present(map,chips[i].start,cfi)) {
+               if (qry_present(map, start, cfi)) {
                        /* Eep. This chip also had the QRY marker. 
                         * Is it an alias for the new one? */
-                       cfi_send_gen_cmd(0xF0, 0, chips[i].start, map, cfi, cfi->device_type, NULL);
+                       cfi_send_gen_cmd(0xF0, 0, start, map, cfi, cfi->device_type, NULL);
+                       cfi_send_gen_cmd(0xFF, 0, start, map, cfi, cfi->device_type, NULL);
 
                        /* If the QRY marker goes away, it's an alias */
-                       if (!qry_present(map, chips[i].start, cfi)) {
+                       if (!qry_present(map, start, cfi)) {
+                               xip_allowed(base, map);
                                printk(KERN_DEBUG "%s: Found an alias at 0x%x for the chip at 0x%lx\n",
-                                      map->name, base, chips[i].start);
+                                      map->name, base, start);
                                return 0;
                        }
                        /* Yes, it's actually got QRY for data. Most 
@@ -97,10 +161,12 @@ static int cfi_probe_chip(struct map_info *map, __u32 base,
                         * too and if it's the same, assume it's an alias. */
                        /* FIXME: Use other modes to do a proper check */
                        cfi_send_gen_cmd(0xF0, 0, base, map, cfi, cfi->device_type, NULL);
+                       cfi_send_gen_cmd(0xFF, 0, start, map, cfi, cfi->device_type, NULL);
                        
                        if (qry_present(map, base, cfi)) {
+                               xip_allowed(base, map);
                                printk(KERN_DEBUG "%s: Found an alias at 0x%x for the chip at 0x%lx\n",
-                                      map->name, base, chips[i].start);
+                                      map->name, base, start);
                                return 0;
                        }
                }
@@ -108,33 +174,30 @@ static int cfi_probe_chip(struct map_info *map, __u32 base,
        
        /* OK, if we got to here, then none of the previous chips appear to
           be aliases for the current one. */
-       if (cfi->numchips == MAX_CFI_CHIPS) {
-               printk(KERN_WARNING"%s: Too many flash chips detected. Increase MAX_CFI_CHIPS from %d.\n", map->name, MAX_CFI_CHIPS);
-               /* Doesn't matter about resetting it to Read Mode - we're not going to talk to it anyway */
-               return -1;
-       }
-       chips[cfi->numchips].start = base;
-       chips[cfi->numchips].state = FL_READY;
+       set_bit((base >> cfi->chipshift), chip_map); /* Update chip map */
        cfi->numchips++;
        
        /* Put it back into Read Mode */
        cfi_send_gen_cmd(0xF0, 0, base, map, cfi, cfi->device_type, NULL);
+       cfi_send_gen_cmd(0xFF, 0, base, map, cfi, cfi->device_type, NULL);
+       xip_allowed(base, map);
 
-       printk(KERN_INFO "%s: Found %d x%d devices at 0x%x in %d-bit mode\n",
+       printk(KERN_INFO "%s: Found %d x%d devices at 0x%x in %d-bit bank\n",
               map->name, cfi->interleave, cfi->device_type*8, base,
-              map->buswidth*8);
+              map->bankwidth*8);
        
        return 1;
 }
 
-static int cfi_chip_setup(struct map_info *map, 
-                  struct cfi_private *cfi)
+static int __xipram cfi_chip_setup(struct map_info *map, 
+                                  struct cfi_private *cfi)
 {
        int ofs_factor = cfi->interleave*cfi->device_type;
        __u32 base = 0;
        int num_erase_regions = cfi_read_query(map, base + (0x10 + 28)*ofs_factor);
        int i;
 
+       xip_enable(base, map, cfi);
 #ifdef DEBUG_CFI
        printk("Number of erase regions: %d\n", num_erase_regions);
 #endif
@@ -150,16 +213,35 @@ static int cfi_chip_setup(struct map_info *map,
        memset(cfi->cfiq,0,sizeof(struct cfi_ident));   
        
        cfi->cfi_mode = CFI_MODE_CFI;
-       cfi->fast_prog=1;               /* CFI supports fast programming */
        
        /* Read the CFI info structure */
-       for (i=0; i<(sizeof(struct cfi_ident) + num_erase_regions * 4); i++) {
+       xip_disable_qry(base, map, cfi);
+       for (i=0; i<(sizeof(struct cfi_ident) + num_erase_regions * 4); i++)
                ((unsigned char *)cfi->cfiq)[i] = cfi_read_query(map,base + (0x10 + i)*ofs_factor);
-       }
-       
+
+       /* Note we put the device back into Read Mode BEFORE going into Auto
+        * Select Mode, as some devices support nesting of modes, others
+        * don't. This way should always work.
+        * On cmdset 0001 the writes of 0xaa and 0x55 are not needed, and
+        * so should be treated as nops or illegal (and so put the device
+        * back into Read Mode, which is a nop in this case).
+        */
+       cfi_send_gen_cmd(0xf0,     0, base, map, cfi, cfi->device_type, NULL);
+       cfi_send_gen_cmd(0xaa, 0x555, base, map, cfi, cfi->device_type, NULL);
+       cfi_send_gen_cmd(0x55, 0x2aa, base, map, cfi, cfi->device_type, NULL);
+       cfi_send_gen_cmd(0x90, 0x555, base, map, cfi, cfi->device_type, NULL);
+       cfi->mfr = cfi_read_query(map, base);
+       cfi->id = cfi_read_query(map, base + ofs_factor);    
+
+       /* Put it back into Read Mode */
+       cfi_send_gen_cmd(0xF0, 0, base, map, cfi, cfi->device_type, NULL);
+       /* ... even if it's an Intel chip */
+       cfi_send_gen_cmd(0xFF, 0, base, map, cfi, cfi->device_type, NULL);
+       xip_allowed(base, map);
+
        /* Do any necessary byteswapping */
        cfi->cfiq->P_ID = le16_to_cpu(cfi->cfiq->P_ID);
-       
+
        cfi->cfiq->P_ADR = le16_to_cpu(cfi->cfiq->P_ADR);
        cfi->cfiq->A_ID = le16_to_cpu(cfi->cfiq->A_ID);
        cfi->cfiq->A_ADR = le16_to_cpu(cfi->cfiq->A_ADR);
@@ -180,8 +262,10 @@ static int cfi_chip_setup(struct map_info *map,
                       (cfi->cfiq->EraseRegionInfo[i] & 0xffff) + 1);
 #endif
        }
-       /* Put it back into Read Mode */
-       cfi_send_gen_cmd(0xF0, 0, base, map, cfi, cfi->device_type, NULL);
+
+       printk(KERN_INFO "%s: Found %d x%d devices at 0x%x in %d-bit bank\n",
+              map->name, cfi->interleave, cfi->device_type*8, base,
+              map->bankwidth*8);
 
        return 1;
 }
@@ -204,12 +288,27 @@ static char *vendorname(__u16 vendor)
                
        case P_ID_AMD_EXT:
                return "AMD/Fujitsu Extended";
+
+       case P_ID_WINBOND:
+               return "Winbond Standard";
                
+       case P_ID_ST_ADV:
+               return "ST Advanced";
+
        case P_ID_MITSUBISHI_STD:
                return "Mitsubishi Standard";
                
        case P_ID_MITSUBISHI_EXT:
                return "Mitsubishi Extended";
+
+       case P_ID_SST_PAGE:
+               return "SST Page Write";
+
+       case P_ID_INTEL_PERFORMANCE:
+               return "Intel Performance Code";
+               
+       case P_ID_INTEL_DATA:
+               return "Intel Data";
                
        case P_ID_RESERVED:
                return "Not Allowed / Reserved for Future Use";
@@ -241,11 +340,11 @@ static void print_cfi_ident(struct cfi_ident *cfip)
                printk("No Alternate Algorithm Table\n");
                
                
-       printk("Vcc Minimum: %x.%x V\n", cfip->VccMin >> 4, cfip->VccMin & 0xf);
-       printk("Vcc Maximum: %x.%x V\n", cfip->VccMax >> 4, cfip->VccMax & 0xf);
+       printk("Vcc Minimum: %2d.%d V\n", cfip->VccMin >> 4, cfip->VccMin & 0xf);
+       printk("Vcc Maximum: %2d.%d V\n", cfip->VccMax >> 4, cfip->VccMax & 0xf);
        if (cfip->VppMin) {
-               printk("Vpp Minimum: %x.%x V\n", cfip->VppMin >> 4, cfip->VppMin & 0xf);
-               printk("Vpp Maximum: %x.%x V\n", cfip->VppMax >> 4, cfip->VppMax & 0xf);
+               printk("Vpp Minimum: %2d.%d V\n", cfip->VppMin >> 4, cfip->VppMin & 0xf);
+               printk("Vpp Maximum: %2d.%d V\n", cfip->VppMax >> 4, cfip->VppMax & 0xf);
        }
        else
                printk("No Vpp line\n");
@@ -288,6 +387,10 @@ static void print_cfi_ident(struct cfi_ident *cfip)
                printk("  - x32-only asynchronous interface\n");
                break;
                
+       case 4:
+               printk("  - supports x16 and x32 via Word# with asynchronous interface\n");
+               break;
+               
        case 65535:
                printk("  - Not Allowed / Reserved\n");
                break;