diff options
Diffstat (limited to 'drivers/mtd/chips/cfi_cmdset_0001.c')
-rw-r--r-- | drivers/mtd/chips/cfi_cmdset_0001.c | 26 |
1 files changed, 22 insertions, 4 deletions
diff --git a/drivers/mtd/chips/cfi_cmdset_0001.c b/drivers/mtd/chips/cfi_cmdset_0001.c index c240454fd113..8664feebc93b 100644 --- a/drivers/mtd/chips/cfi_cmdset_0001.c +++ b/drivers/mtd/chips/cfi_cmdset_0001.c | |||
@@ -46,6 +46,7 @@ | |||
46 | #define MANUFACTURER_INTEL 0x0089 | 46 | #define MANUFACTURER_INTEL 0x0089 |
47 | #define I82802AB 0x00ad | 47 | #define I82802AB 0x00ad |
48 | #define I82802AC 0x00ac | 48 | #define I82802AC 0x00ac |
49 | #define PF38F4476 0x881c | ||
49 | #define MANUFACTURER_ST 0x0020 | 50 | #define MANUFACTURER_ST 0x0020 |
50 | #define M50LPW080 0x002F | 51 | #define M50LPW080 0x002F |
51 | #define M50FLW080A 0x0080 | 52 | #define M50FLW080A 0x0080 |
@@ -315,10 +316,20 @@ static struct cfi_fixup fixup_table[] = { | |||
315 | { 0, 0, NULL, NULL } | 316 | { 0, 0, NULL, NULL } |
316 | }; | 317 | }; |
317 | 318 | ||
319 | static void cfi_fixup_major_minor(struct cfi_private *cfi, | ||
320 | struct cfi_pri_intelext *extp) | ||
321 | { | ||
322 | if (cfi->mfr == MANUFACTURER_INTEL && | ||
323 | cfi->id == PF38F4476 && extp->MinorVersion == '3') | ||
324 | extp->MinorVersion = '1'; | ||
325 | } | ||
326 | |||
318 | static inline struct cfi_pri_intelext * | 327 | static inline struct cfi_pri_intelext * |
319 | read_pri_intelext(struct map_info *map, __u16 adr) | 328 | read_pri_intelext(struct map_info *map, __u16 adr) |
320 | { | 329 | { |
330 | struct cfi_private *cfi = map->fldrv_priv; | ||
321 | struct cfi_pri_intelext *extp; | 331 | struct cfi_pri_intelext *extp; |
332 | unsigned int extra_size = 0; | ||
322 | unsigned int extp_size = sizeof(*extp); | 333 | unsigned int extp_size = sizeof(*extp); |
323 | 334 | ||
324 | again: | 335 | again: |
@@ -326,6 +337,8 @@ read_pri_intelext(struct map_info *map, __u16 adr) | |||
326 | if (!extp) | 337 | if (!extp) |
327 | return NULL; | 338 | return NULL; |
328 | 339 | ||
340 | cfi_fixup_major_minor(cfi, extp); | ||
341 | |||
329 | if (extp->MajorVersion != '1' || | 342 | if (extp->MajorVersion != '1' || |
330 | (extp->MinorVersion < '0' || extp->MinorVersion > '5')) { | 343 | (extp->MinorVersion < '0' || extp->MinorVersion > '5')) { |
331 | printk(KERN_ERR " Unknown Intel/Sharp Extended Query " | 344 | printk(KERN_ERR " Unknown Intel/Sharp Extended Query " |
@@ -340,19 +353,24 @@ read_pri_intelext(struct map_info *map, __u16 adr) | |||
340 | extp->BlkStatusRegMask = le16_to_cpu(extp->BlkStatusRegMask); | 353 | extp->BlkStatusRegMask = le16_to_cpu(extp->BlkStatusRegMask); |
341 | extp->ProtRegAddr = le16_to_cpu(extp->ProtRegAddr); | 354 | extp->ProtRegAddr = le16_to_cpu(extp->ProtRegAddr); |
342 | 355 | ||
343 | if (extp->MajorVersion == '1' && extp->MinorVersion >= '3') { | 356 | if (extp->MinorVersion >= '0') { |
344 | unsigned int extra_size = 0; | 357 | extra_size = 0; |
345 | int nb_parts, i; | ||
346 | 358 | ||
347 | /* Protection Register info */ | 359 | /* Protection Register info */ |
348 | extra_size += (extp->NumProtectionFields - 1) * | 360 | extra_size += (extp->NumProtectionFields - 1) * |
349 | sizeof(struct cfi_intelext_otpinfo); | 361 | sizeof(struct cfi_intelext_otpinfo); |
362 | } | ||
350 | 363 | ||
364 | if (extp->MinorVersion >= '1') { | ||
351 | /* Burst Read info */ | 365 | /* Burst Read info */ |
352 | extra_size += 2; | 366 | extra_size += 2; |
353 | if (extp_size < sizeof(*extp) + extra_size) | 367 | if (extp_size < sizeof(*extp) + extra_size) |
354 | goto need_more; | 368 | goto need_more; |
355 | extra_size += extp->extra[extra_size-1]; | 369 | extra_size += extp->extra[extra_size - 1]; |
370 | } | ||
371 | |||
372 | if (extp->MinorVersion >= '3') { | ||
373 | int nb_parts, i; | ||
356 | 374 | ||
357 | /* Number of hardware-partitions */ | 375 | /* Number of hardware-partitions */ |
358 | extra_size += 1; | 376 | extra_size += 1; |