mtd/chips/cfi_probe.c

19 #include <linux/mtd/cfi.h>
29 			  unsigned long *chip_map, struct cfi_private *cfi);
30 static int cfi_chip_setup(struct map_info *map, struct cfi_private *cfi);
46 #define xip_enable(base, map, cfi) \
48 	cfi_qry_mode_off(base, map, cfi);		\
52 #define xip_disable_qry(base, map, cfi) \
55 	cfi_qry_mode_on(base, map, cfi); \
62 #define xip_enable(base, map, cfi)	do { } while (0)
63 #define xip_disable_qry(base, map, cfi) do { } while (0)
75 	void (*fixup)(struct cfi_private *cfi);
78 static void cfi_early_fixup(struct cfi_private *cfi,
84 		if (((f->mfr == CFI_MFR_ANY) || (f->mfr == cfi->mfr)) &&
85 		    ((f->id == CFI_ID_ANY) || (f->id == cfi->id))) {
86 			f->fixup(cfi);
97 				   unsigned long *chip_map, struct cfi_private *cfi)
115 	if (!cfi_qry_mode_on(base, map, cfi)) {
116 		xip_enable(base, map, cfi);
120 	if (!cfi->numchips) {
123 		return cfi_chip_setup(map, cfi);
127  	for (i=0; i < (base >> cfi->chipshift); i++) {
133  		start = i << cfi->chipshift;
136 		if (cfi_qry_present(map, start, cfi)) {
139 			cfi_qry_mode_off(start, map, cfi);
142 			if (!cfi_qry_present(map, start, cfi)) {
152 			cfi_qry_mode_off(base, map, cfi);
154 			if (cfi_qry_present(map, base, cfi)) {
165 	set_bit((base >> cfi->chipshift), chip_map); /* Update chip map */
166 	cfi->numchips++;
169 	cfi_qry_mode_off(base, map, cfi);
173 	       map->name, cfi->interleave, cfi->device_type*8, base,
179 static void fixup_s70gl02gs_chips(struct cfi_private *cfi)
185 	cfi->cfiq->DevSize = 27;
186 	cfi->cfiq->EraseRegionInfo[0] = 0x20003ff;
196 				   struct cfi_private *cfi)
198 	int ofs_factor = cfi->interleave*cfi->device_type;
204 	xip_enable(base, map, cfi);
211 	cfi->cfiq = kmalloc(sizeof(struct cfi_ident) + num_erase_regions * 4, GFP_KERNEL);
212 	if (!cfi->cfiq)
215 	memset(cfi->cfiq,0,sizeof(struct cfi_ident));
217 	cfi->cfi_mode = CFI_MODE_CFI;
219 	cfi->sector_erase_cmd = CMD(0x30);
222 	xip_disable_qry(base, map, cfi);
224 		((unsigned char *)cfi->cfiq)[i] = cfi_read_query(map,base + (0x10 + i)*ofs_factor);
227 	cfi->cfiq->P_ID = le16_to_cpu(cfi->cfiq->P_ID);
229 	cfi->cfiq->P_ADR = le16_to_cpu(cfi->cfiq->P_ADR);
230 	cfi->cfiq->A_ID = le16_to_cpu(cfi->cfiq->A_ID);
231 	cfi->cfiq->A_ADR = le16_to_cpu(cfi->cfiq->A_ADR);
232 	cfi->cfiq->InterfaceDesc = le16_to_cpu(cfi->cfiq->InterfaceDesc);
233 	cfi->cfiq->MaxBufWriteSize = le16_to_cpu(cfi->cfiq->MaxBufWriteSize);
237 	print_cfi_ident(cfi->cfiq);
240 	for (i=0; i<cfi->cfiq->NumEraseRegions; i++) {
241 		cfi->cfiq->EraseRegionInfo[i] = le32_to_cpu(cfi->cfiq->EraseRegionInfo[i]);
245 		       i, (cfi->cfiq->EraseRegionInfo[i] >> 8) & ~0xff,
246 		       (cfi->cfiq->EraseRegionInfo[i] & 0xffff) + 1);
250 	if (cfi->cfiq->P_ID == P_ID_SST_OLD) {
263 	cfi_send_gen_cmd(0xf0,     0, base, map, cfi, cfi->device_type, NULL);
264 	cfi_send_gen_cmd(0xaa, addr_unlock1, base, map, cfi, cfi->device_type, NULL);
265 	cfi_send_gen_cmd(0x55, addr_unlock2, base, map, cfi, cfi->device_type, NULL);
266 	cfi_send_gen_cmd(0x90, addr_unlock1, base, map, cfi, cfi->device_type, NULL);
267 	cfi->mfr = cfi_read_query16(map, base);
268 	cfi->id = cfi_read_query16(map, base + ofs_factor);
271 	if (cfi->mfr == CFI_MFR_AMD && (cfi->id & 0xff) == 0x7e)
272 		cfi->id = cfi_read_query(map, base + 0xe * ofs_factor) << 8 |
276 	cfi_qry_mode_off(base, map, cfi);
279 	cfi_early_fixup(cfi, cfi_early_fixup_table);
282 	       map->name, cfi->interleave, cfi->device_type*8, base,
283 	       map->bankwidth*8, cfi->mfr, cfi->id);