| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273 |
- --- a/drivers/mtd/spi-nor/spi-nor.c
- +++ b/drivers/mtd/spi-nor/spi-nor.c
- @@ -142,20 +142,29 @@ static int read_fsr(struct spi_nor *nor)
- * location. Return the configuration register value.
- * Returns negative if error occurred.
- */
- -static int read_cr(struct spi_nor *nor)
- +static int _read_cr(struct spi_nor *nor, u8 reg)
- {
- int ret;
- u8 val;
-
- - ret = nor->read_reg(nor, SPINOR_OP_RDCR, &val, 1);
- + ret = nor->read_reg(nor, reg, &val, 1);
- if (ret < 0) {
- - dev_err(nor->dev, "error %d reading CR\n", ret);
- + dev_err(nor->dev, "error %d reading %s\n", ret,
- + (reg==SPINOR_OP_RDCR)?"CR":"XCR");
- return ret;
- }
-
- return val;
- }
-
- +static inline int read_cr(struct spi_nor *nor) {
- + return _read_cr(nor, SPINOR_OP_RDCR);
- +}
- +
- +static inline int read_xcr(struct spi_nor *nor) {
- + return _read_cr(nor, SPINOR_OP_RDXCR);
- +}
- +
- /*
- * Write status register 1 byte
- * Returns negative if error occurred.
- @@ -2889,9 +2898,16 @@ int spi_nor_scan(struct spi_nor *nor, co
- } else if (mtd->size > 0x1000000) {
- /* enable 4-byte addressing if the device exceeds 16MiB */
- nor->addr_width = 4;
- - if (info->flags & SPI_NOR_4B_READ_OP)
- - spi_nor_set_4byte_read(nor, info);
- - else if (JEDEC_MFR(info) == SNOR_MFR_SPANSION ||
- + if (info->flags & SPI_NOR_4B_READ_OP) {
- + if (JEDEC_MFR(info) == SNOR_MFR_WINBOND) {
- + ret = read_xcr(nor);
- + if (!(ret > 0 && (ret & XCR_DEF_4B_ADDR_MODE)))
- + spi_nor_set_4byte_read(nor, info);
- + else
- + set_4byte(nor, info, 1);
- + } else
- + spi_nor_set_4byte_read(nor, info);
- + } else if (JEDEC_MFR(info) == SNOR_MFR_SPANSION ||
- info->flags & SPI_NOR_4B_OPCODES)
- spi_nor_set_4byte_opcodes(nor, info);
- else
- --- a/include/linux/mtd/spi-nor.h
- +++ b/include/linux/mtd/spi-nor.h
- @@ -103,6 +103,7 @@
- #define SPINOR_OP_EN4B 0xb7 /* Enter 4-byte mode */
- #define SPINOR_OP_EX4B 0xe9 /* Exit 4-byte mode */
- #define SPINOR_OP_WREAR 0xc5 /* Write extended address register */
- +#define SPINOR_OP_RDXCR 0x15 /* Read extended configuration register */
-
- /* Used for Spansion flashes only. */
- #define SPINOR_OP_BRWR 0x17 /* Bank register write */
- @@ -135,6 +136,7 @@
-
- /* Configuration Register bits. */
- #define CR_QUAD_EN_SPAN BIT(1) /* Spansion Quad I/O */
- +#define XCR_DEF_4B_ADDR_MODE BIT(1) /* Winbond 4B mode default */
-
- /* Status Register 2 bits. */
- #define SR2_QUAD_EN_BIT7 BIT(7)
|