2 * Common Flash Interface support:
3 * Generic utility functions not dependant on command set
5 * Copyright (C) 2002 Red Hat
6 * Copyright (C) 2003 STMicroelectronics Limited
8 * This code is covered by the GPL.
11 #include <linux/module.h>
12 #include <linux/types.h>
13 #include <linux/kernel.h>
15 #include <asm/byteorder.h>
17 #include <linux/errno.h>
18 #include <linux/slab.h>
19 #include <linux/delay.h>
20 #include <linux/interrupt.h>
21 #include <linux/mtd/xip.h>
22 #include <linux/mtd/mtd.h>
23 #include <linux/mtd/map.h>
24 #include <linux/mtd/cfi.h>
25 #include <linux/mtd/compatmac.h>
27 int __xipram cfi_qry_present(struct map_info *map, __u32 base,
28 struct cfi_private *cfi)
30 int osf = cfi->interleave * cfi->device_type; /* scale factor */
34 qry[0] = cfi_build_cmd('Q', map, cfi);
35 qry[1] = cfi_build_cmd('R', map, cfi);
36 qry[2] = cfi_build_cmd('Y', map, cfi);
38 val[0] = map_read(map, base + osf*0x10);
39 val[1] = map_read(map, base + osf*0x11);
40 val[2] = map_read(map, base + osf*0x12);
42 if (!map_word_equal(map, qry[0], val[0]))
45 if (!map_word_equal(map, qry[1], val[1]))
48 if (!map_word_equal(map, qry[2], val[2]))
51 return 1; /* "QRY" found */
53 EXPORT_SYMBOL_GPL(cfi_qry_present);
55 int __xipram cfi_qry_mode_on(uint32_t base, struct map_info *map,
56 struct cfi_private *cfi)
58 cfi_send_gen_cmd(0xF0, 0, base, map, cfi, cfi->device_type, NULL);
59 cfi_send_gen_cmd(0x98, 0x55, base, map, cfi, cfi->device_type, NULL);
60 if (cfi_qry_present(map, base, cfi))
62 /* QRY not found probably we deal with some odd CFI chips */
63 /* Some revisions of some old Intel chips? */
64 cfi_send_gen_cmd(0xF0, 0, base, map, cfi, cfi->device_type, NULL);
65 cfi_send_gen_cmd(0xFF, 0, base, map, cfi, cfi->device_type, NULL);
66 cfi_send_gen_cmd(0x98, 0x55, base, map, cfi, cfi->device_type, NULL);
67 if (cfi_qry_present(map, base, cfi))
70 cfi_send_gen_cmd(0xF0, 0, base, map, cfi, cfi->device_type, NULL);
71 cfi_send_gen_cmd(0x98, 0x555, base, map, cfi, cfi->device_type, NULL);
72 if (cfi_qry_present(map, base, cfi))
74 /* some old SST chips, e.g. 39VF160x/39VF320x */
75 cfi_send_gen_cmd(0xF0, 0, base, map, cfi, cfi->device_type, NULL);
76 cfi_send_gen_cmd(0xAA, 0x5555, base, map, cfi, cfi->device_type, NULL);
77 cfi_send_gen_cmd(0x55, 0x2AAA, base, map, cfi, cfi->device_type, NULL);
78 cfi_send_gen_cmd(0x98, 0x5555, base, map, cfi, cfi->device_type, NULL);
79 if (cfi_qry_present(map, base, cfi))
84 EXPORT_SYMBOL_GPL(cfi_qry_mode_on);
86 void __xipram cfi_qry_mode_off(uint32_t base, struct map_info *map,
87 struct cfi_private *cfi)
89 cfi_send_gen_cmd(0xF0, 0, base, map, cfi, cfi->device_type, NULL);
90 cfi_send_gen_cmd(0xFF, 0, base, map, cfi, cfi->device_type, NULL);
91 /* M29W128G flashes require an additional reset command
93 if ((cfi->mfr == CFI_MFR_ST) && (cfi->id == 0x227E || cfi->id == 0x7E))
94 cfi_send_gen_cmd(0xF0, 0, base, map, cfi, cfi->device_type, NULL);
96 EXPORT_SYMBOL_GPL(cfi_qry_mode_off);
99 __xipram cfi_read_pri(struct map_info *map, __u16 adr, __u16 size, const char* name)
101 struct cfi_private *cfi = map->fldrv_priv;
102 __u32 base = 0; // cfi->chips[0].start;
103 int ofs_factor = cfi->interleave * cfi->device_type;
105 struct cfi_extquery *extp = NULL;
110 printk(KERN_INFO "%s Extended Query Table at 0x%4.4X\n", name, adr);
112 extp = kmalloc(size, GFP_KERNEL);
114 printk(KERN_ERR "Failed to allocate memory\n");
118 #ifdef CONFIG_MTD_XIP
122 /* Switch it into Query Mode */
123 cfi_qry_mode_on(base, map, cfi);
124 /* Read in the Extended Query Table */
125 for (i=0; i<size; i++) {
126 ((unsigned char *)extp)[i] =
127 cfi_read_query(map, base+((adr+i)*ofs_factor));
130 /* Make sure it returns to read mode */
131 cfi_qry_mode_off(base, map, cfi);
133 #ifdef CONFIG_MTD_XIP
134 (void) map_read(map, base);
142 EXPORT_SYMBOL(cfi_read_pri);
144 void cfi_fixup(struct mtd_info *mtd, struct cfi_fixup *fixups)
146 struct map_info *map = mtd->priv;
147 struct cfi_private *cfi = map->fldrv_priv;
150 for (f=fixups; f->fixup; f++) {
151 if (((f->mfr == CFI_MFR_ANY) || (f->mfr == cfi->mfr)) &&
152 ((f->id == CFI_ID_ANY) || (f->id == cfi->id))) {
153 f->fixup(mtd, f->param);
158 EXPORT_SYMBOL(cfi_fixup);
160 int cfi_varsize_frob(struct mtd_info *mtd, varsize_frob_t frob,
161 loff_t ofs, size_t len, void *thunk)
163 struct map_info *map = mtd->priv;
164 struct cfi_private *cfi = map->fldrv_priv;
166 int chipnum, ret = 0;
168 struct mtd_erase_region_info *regions = mtd->eraseregions;
173 if ((len + ofs) > mtd->size)
176 /* Check that both start and end of the requested erase are
177 * aligned with the erasesize at the appropriate addresses.
182 /* Skip all erase regions which are ended before the start of
183 the requested erase. Actually, to save on the calculations,
184 we skip to the first erase region which starts after the
185 start of the requested erase, and then go back one.
188 while (i < mtd->numeraseregions && ofs >= regions[i].offset)
192 /* OK, now i is pointing at the erase region in which this
193 erase request starts. Check the start of the requested
194 erase range is aligned with the erase size which is in
198 if (ofs & (regions[i].erasesize-1))
201 /* Remember the erase region we start on */
204 /* Next, check that the end of the requested erase is aligned
205 * with the erase region at that address.
208 while (i<mtd->numeraseregions && (ofs + len) >= regions[i].offset)
211 /* As before, drop back one to point at the region in which
212 the address actually falls
216 if ((ofs + len) & (regions[i].erasesize-1))
219 chipnum = ofs >> cfi->chipshift;
220 adr = ofs - (chipnum << cfi->chipshift);
225 int size = regions[i].erasesize;
227 ret = (*frob)(map, &cfi->chips[chipnum], adr, size, thunk);
236 if (ofs == regions[i].offset + size * regions[i].numblocks)
239 if (adr >> cfi->chipshift) {
243 if (chipnum >= cfi->numchips)
251 EXPORT_SYMBOL(cfi_varsize_frob);
253 MODULE_LICENSE("GPL");