|
|
@ -0,0 +1,808 @@ |
|
|
|
|
|
|
|
--- a/drivers/mtd/devices/m25p80.c
|
|
|
|
|
|
|
|
+++ b/drivers/mtd/devices/m25p80.c
|
|
|
|
|
|
|
|
@@ -31,7 +31,6 @@
|
|
|
|
|
|
|
|
struct m25p {
|
|
|
|
|
|
|
|
struct spi_device *spi;
|
|
|
|
|
|
|
|
struct spi_nor spi_nor;
|
|
|
|
|
|
|
|
- struct mtd_info mtd;
|
|
|
|
|
|
|
|
u8 command[MAX_CMD_SIZE];
|
|
|
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
@@ -62,8 +61,7 @@ static int m25p_cmdsz(struct spi_nor *no
|
|
|
|
|
|
|
|
return 1 + nor->addr_width;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
-static int m25p80_write_reg(struct spi_nor *nor, u8 opcode, u8 *buf, int len,
|
|
|
|
|
|
|
|
- int wr_en)
|
|
|
|
|
|
|
|
+static int m25p80_write_reg(struct spi_nor *nor, u8 opcode, u8 *buf, int len)
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
struct m25p *flash = nor->priv;
|
|
|
|
|
|
|
|
struct spi_device *spi = flash->spi;
|
|
|
|
|
|
|
|
@@ -159,7 +157,7 @@ static int m25p80_erase(struct spi_nor *
|
|
|
|
|
|
|
|
struct m25p *flash = nor->priv;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
dev_dbg(nor->dev, "%dKiB at 0x%08x\n",
|
|
|
|
|
|
|
|
- flash->mtd.erasesize / 1024, (u32)offset);
|
|
|
|
|
|
|
|
+ flash->spi_nor.mtd.erasesize / 1024, (u32)offset);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Set up command buffer. */
|
|
|
|
|
|
|
|
flash->command[0] = nor->erase_opcode;
|
|
|
|
|
|
|
|
@@ -201,11 +199,10 @@ static int m25p_probe(struct spi_device
|
|
|
|
|
|
|
|
nor->read_reg = m25p80_read_reg;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
nor->dev = &spi->dev;
|
|
|
|
|
|
|
|
- nor->mtd = &flash->mtd;
|
|
|
|
|
|
|
|
+ nor->flash_node = spi->dev.of_node;
|
|
|
|
|
|
|
|
nor->priv = flash;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
spi_set_drvdata(spi, flash);
|
|
|
|
|
|
|
|
- flash->mtd.priv = nor;
|
|
|
|
|
|
|
|
flash->spi = spi;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (spi->mode & SPI_RX_QUAD)
|
|
|
|
|
|
|
|
@@ -214,7 +211,7 @@ static int m25p_probe(struct spi_device
|
|
|
|
|
|
|
|
mode = SPI_NOR_DUAL;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (data && data->name)
|
|
|
|
|
|
|
|
- flash->mtd.name = data->name;
|
|
|
|
|
|
|
|
+ nor->mtd.name = data->name;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* For some (historical?) reason many platforms provide two different
|
|
|
|
|
|
|
|
* names in flash_platform_data: "name" and "type". Quite often name is
|
|
|
|
|
|
|
|
@@ -232,7 +229,7 @@ static int m25p_probe(struct spi_device
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
ppdata.of_node = spi->dev.of_node;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- return mtd_device_parse_register(&flash->mtd, NULL, &ppdata,
|
|
|
|
|
|
|
|
+ return mtd_device_parse_register(&nor->mtd, NULL, &ppdata,
|
|
|
|
|
|
|
|
data ? data->parts : NULL,
|
|
|
|
|
|
|
|
data ? data->nr_parts : 0);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
@@ -243,7 +240,7 @@ static int m25p_remove(struct spi_device
|
|
|
|
|
|
|
|
struct m25p *flash = spi_get_drvdata(spi);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Clean up MTD stuff. */
|
|
|
|
|
|
|
|
- return mtd_device_unregister(&flash->mtd);
|
|
|
|
|
|
|
|
+ return mtd_device_unregister(&flash->spi_nor.mtd);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
|
|
|
@@ -304,7 +301,6 @@ MODULE_DEVICE_TABLE(of, m25p_of_table);
|
|
|
|
|
|
|
|
static struct spi_driver m25p80_driver = {
|
|
|
|
|
|
|
|
.driver = {
|
|
|
|
|
|
|
|
.name = "m25p80",
|
|
|
|
|
|
|
|
- .owner = THIS_MODULE,
|
|
|
|
|
|
|
|
.of_match_table = m25p_of_table,
|
|
|
|
|
|
|
|
},
|
|
|
|
|
|
|
|
.id_table = m25p_ids,
|
|
|
|
|
|
|
|
--- a/drivers/mtd/spi-nor/spi-nor.c
|
|
|
|
|
|
|
|
+++ b/drivers/mtd/spi-nor/spi-nor.c
|
|
|
|
|
|
|
|
@@ -16,15 +16,26 @@
|
|
|
|
|
|
|
|
#include <linux/device.h>
|
|
|
|
|
|
|
|
#include <linux/mutex.h>
|
|
|
|
|
|
|
|
#include <linux/math64.h>
|
|
|
|
|
|
|
|
+#include <linux/sizes.h>
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
-#include <linux/mtd/cfi.h>
|
|
|
|
|
|
|
|
#include <linux/mtd/mtd.h>
|
|
|
|
|
|
|
|
#include <linux/of_platform.h>
|
|
|
|
|
|
|
|
#include <linux/spi/flash.h>
|
|
|
|
|
|
|
|
#include <linux/mtd/spi-nor.h>
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Define max times to check status register before we give up. */
|
|
|
|
|
|
|
|
-#define MAX_READY_WAIT_JIFFIES (40 * HZ) /* M25P16 specs 40s max chip erase */
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+/*
|
|
|
|
|
|
|
|
+ * For everything but full-chip erase; probably could be much smaller, but kept
|
|
|
|
|
|
|
|
+ * around for safety for now
|
|
|
|
|
|
|
|
+ */
|
|
|
|
|
|
|
|
+#define DEFAULT_READY_WAIT_JIFFIES (40UL * HZ)
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+/*
|
|
|
|
|
|
|
|
+ * For full-chip erase, calibrated to a 2MB flash (M25P16); should be scaled up
|
|
|
|
|
|
|
|
+ * for larger flash
|
|
|
|
|
|
|
|
+ */
|
|
|
|
|
|
|
|
+#define CHIP_ERASE_2MB_READY_WAIT_JIFFIES (40UL * HZ)
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#define SPI_NOR_MAX_ID_LEN 6
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
@@ -145,7 +156,7 @@ static inline int spi_nor_read_dummy_cyc
|
|
|
|
|
|
|
|
static inline int write_sr(struct spi_nor *nor, u8 val)
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
nor->cmd_buf[0] = val;
|
|
|
|
|
|
|
|
- return nor->write_reg(nor, SPINOR_OP_WRSR, nor->cmd_buf, 1, 0);
|
|
|
|
|
|
|
|
+ return nor->write_reg(nor, SPINOR_OP_WRSR, nor->cmd_buf, 1);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
|
|
|
@@ -154,7 +165,7 @@ static inline int write_sr(struct spi_no
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
static inline int write_enable(struct spi_nor *nor)
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
- return nor->write_reg(nor, SPINOR_OP_WREN, NULL, 0, 0);
|
|
|
|
|
|
|
|
+ return nor->write_reg(nor, SPINOR_OP_WREN, NULL, 0);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
|
|
|
@@ -162,7 +173,7 @@ static inline int write_enable(struct sp
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
static inline int write_disable(struct spi_nor *nor)
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
- return nor->write_reg(nor, SPINOR_OP_WRDI, NULL, 0, 0);
|
|
|
|
|
|
|
|
+ return nor->write_reg(nor, SPINOR_OP_WRDI, NULL, 0);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static inline struct spi_nor *mtd_to_spi_nor(struct mtd_info *mtd)
|
|
|
|
|
|
|
|
@@ -179,16 +190,16 @@ static inline int set_4byte(struct spi_n
|
|
|
|
|
|
|
|
u8 cmd;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
switch (JEDEC_MFR(info)) {
|
|
|
|
|
|
|
|
- case CFI_MFR_ST: /* Micron, actually */
|
|
|
|
|
|
|
|
+ case SNOR_MFR_MICRON:
|
|
|
|
|
|
|
|
/* Some Micron need WREN command; all will accept it */
|
|
|
|
|
|
|
|
need_wren = true;
|
|
|
|
|
|
|
|
- case CFI_MFR_MACRONIX:
|
|
|
|
|
|
|
|
- case 0xEF /* winbond */:
|
|
|
|
|
|
|
|
+ case SNOR_MFR_MACRONIX:
|
|
|
|
|
|
|
|
+ case SNOR_MFR_WINBOND:
|
|
|
|
|
|
|
|
if (need_wren)
|
|
|
|
|
|
|
|
write_enable(nor);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
cmd = enable ? SPINOR_OP_EN4B : SPINOR_OP_EX4B;
|
|
|
|
|
|
|
|
- status = nor->write_reg(nor, cmd, NULL, 0, 0);
|
|
|
|
|
|
|
|
+ status = nor->write_reg(nor, cmd, NULL, 0);
|
|
|
|
|
|
|
|
if (need_wren)
|
|
|
|
|
|
|
|
write_disable(nor);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
@@ -196,7 +207,7 @@ static inline int set_4byte(struct spi_n
|
|
|
|
|
|
|
|
default:
|
|
|
|
|
|
|
|
/* Spansion style */
|
|
|
|
|
|
|
|
nor->cmd_buf[0] = enable << 7;
|
|
|
|
|
|
|
|
- return nor->write_reg(nor, SPINOR_OP_BRWR, nor->cmd_buf, 1, 0);
|
|
|
|
|
|
|
|
+ return nor->write_reg(nor, SPINOR_OP_BRWR, nor->cmd_buf, 1);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline int spi_nor_sr_ready(struct spi_nor *nor)
|
|
|
|
|
|
|
|
@@ -233,12 +244,13 @@ static int spi_nor_ready(struct spi_nor
|
|
|
|
|
|
|
|
* Service routine to read status register until ready, or timeout occurs.
|
|
|
|
|
|
|
|
* Returns non-zero if error.
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
-static int spi_nor_wait_till_ready(struct spi_nor *nor)
|
|
|
|
|
|
|
|
+static int spi_nor_wait_till_ready_with_timeout(struct spi_nor *nor,
|
|
|
|
|
|
|
|
+ unsigned long timeout_jiffies)
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
unsigned long deadline;
|
|
|
|
|
|
|
|
int timeout = 0, ret;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- deadline = jiffies + MAX_READY_WAIT_JIFFIES;
|
|
|
|
|
|
|
|
+ deadline = jiffies + timeout_jiffies;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
while (!timeout) {
|
|
|
|
|
|
|
|
if (time_after_eq(jiffies, deadline))
|
|
|
|
|
|
|
|
@@ -258,6 +270,12 @@ static int spi_nor_wait_till_ready(struc
|
|
|
|
|
|
|
|
return -ETIMEDOUT;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
+static int spi_nor_wait_till_ready(struct spi_nor *nor)
|
|
|
|
|
|
|
|
+{
|
|
|
|
|
|
|
|
+ return spi_nor_wait_till_ready_with_timeout(nor,
|
|
|
|
|
|
|
|
+ DEFAULT_READY_WAIT_JIFFIES);
|
|
|
|
|
|
|
|
+}
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
|
|
|
* Erase the whole flash memory
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
@@ -265,9 +283,9 @@ static int spi_nor_wait_till_ready(struc
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
static int erase_chip(struct spi_nor *nor)
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
- dev_dbg(nor->dev, " %lldKiB\n", (long long)(nor->mtd->size >> 10));
|
|
|
|
|
|
|
|
+ dev_dbg(nor->dev, " %lldKiB\n", (long long)(nor->mtd.size >> 10));
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- return nor->write_reg(nor, SPINOR_OP_CHIP_ERASE, NULL, 0, 0);
|
|
|
|
|
|
|
|
+ return nor->write_reg(nor, SPINOR_OP_CHIP_ERASE, NULL, 0);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static int spi_nor_lock_and_prep(struct spi_nor *nor, enum spi_nor_ops ops)
|
|
|
|
|
|
|
|
@@ -321,6 +339,8 @@ static int spi_nor_erase(struct mtd_info
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* whole-chip erase? */
|
|
|
|
|
|
|
|
if (len == mtd->size) {
|
|
|
|
|
|
|
|
+ unsigned long timeout;
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
write_enable(nor);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (erase_chip(nor)) {
|
|
|
|
|
|
|
|
@@ -328,7 +348,16 @@ static int spi_nor_erase(struct mtd_info
|
|
|
|
|
|
|
|
goto erase_err;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- ret = spi_nor_wait_till_ready(nor);
|
|
|
|
|
|
|
|
+ /*
|
|
|
|
|
|
|
|
+ * Scale the timeout linearly with the size of the flash, with
|
|
|
|
|
|
|
|
+ * a minimum calibrated to an old 2MB flash. We could try to
|
|
|
|
|
|
|
|
+ * pull these from CFI/SFDP, but these values should be good
|
|
|
|
|
|
|
|
+ * enough for now.
|
|
|
|
|
|
|
|
+ */
|
|
|
|
|
|
|
|
+ timeout = max(CHIP_ERASE_2MB_READY_WAIT_JIFFIES,
|
|
|
|
|
|
|
|
+ CHIP_ERASE_2MB_READY_WAIT_JIFFIES *
|
|
|
|
|
|
|
|
+ (unsigned long)(mtd->size / SZ_2M));
|
|
|
|
|
|
|
|
+ ret = spi_nor_wait_till_ready_with_timeout(nor, timeout);
|
|
|
|
|
|
|
|
if (ret)
|
|
|
|
|
|
|
|
goto erase_err;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
@@ -371,72 +400,171 @@ erase_err:
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
+static void stm_get_locked_range(struct spi_nor *nor, u8 sr, loff_t *ofs,
|
|
|
|
|
|
|
|
+ uint64_t *len)
|
|
|
|
|
|
|
|
+{
|
|
|
|
|
|
|
|
+ struct mtd_info *mtd = &nor->mtd;
|
|
|
|
|
|
|
|
+ u8 mask = SR_BP2 | SR_BP1 | SR_BP0;
|
|
|
|
|
|
|
|
+ int shift = ffs(mask) - 1;
|
|
|
|
|
|
|
|
+ int pow;
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+ if (!(sr & mask)) {
|
|
|
|
|
|
|
|
+ /* No protection */
|
|
|
|
|
|
|
|
+ *ofs = 0;
|
|
|
|
|
|
|
|
+ *len = 0;
|
|
|
|
|
|
|
|
+ } else {
|
|
|
|
|
|
|
|
+ pow = ((sr & mask) ^ mask) >> shift;
|
|
|
|
|
|
|
|
+ *len = mtd->size >> pow;
|
|
|
|
|
|
|
|
+ *ofs = mtd->size - *len;
|
|
|
|
|
|
|
|
+ }
|
|
|
|
|
|
|
|
+}
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+/*
|
|
|
|
|
|
|
|
+ * Return 1 if the entire region is locked, 0 otherwise
|
|
|
|
|
|
|
|
+ */
|
|
|
|
|
|
|
|
+static int stm_is_locked_sr(struct spi_nor *nor, loff_t ofs, uint64_t len,
|
|
|
|
|
|
|
|
+ u8 sr)
|
|
|
|
|
|
|
|
+{
|
|
|
|
|
|
|
|
+ loff_t lock_offs;
|
|
|
|
|
|
|
|
+ uint64_t lock_len;
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+ stm_get_locked_range(nor, sr, &lock_offs, &lock_len);
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+ return (ofs + len <= lock_offs + lock_len) && (ofs >= lock_offs);
|
|
|
|
|
|
|
|
+}
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+/*
|
|
|
|
|
|
|
|
+ * Lock a region of the flash. Compatible with ST Micro and similar flash.
|
|
|
|
|
|
|
|
+ * Supports only the block protection bits BP{0,1,2} in the status register
|
|
|
|
|
|
|
|
+ * (SR). Does not support these features found in newer SR bitfields:
|
|
|
|
|
|
|
|
+ * - TB: top/bottom protect - only handle TB=0 (top protect)
|
|
|
|
|
|
|
|
+ * - SEC: sector/block protect - only handle SEC=0 (block protect)
|
|
|
|
|
|
|
|
+ * - CMP: complement protect - only support CMP=0 (range is not complemented)
|
|
|
|
|
|
|
|
+ *
|
|
|
|
|
|
|
|
+ * Sample table portion for 8MB flash (Winbond w25q64fw):
|
|
|
|
|
|
|
|
+ *
|
|
|
|
|
|
|
|
+ * SEC | TB | BP2 | BP1 | BP0 | Prot Length | Protected Portion
|
|
|
|
|
|
|
|
+ * --------------------------------------------------------------------------
|
|
|
|
|
|
|
|
+ * X | X | 0 | 0 | 0 | NONE | NONE
|
|
|
|
|
|
|
|
+ * 0 | 0 | 0 | 0 | 1 | 128 KB | Upper 1/64
|
|
|
|
|
|
|
|
+ * 0 | 0 | 0 | 1 | 0 | 256 KB | Upper 1/32
|
|
|
|
|
|
|
|
+ * 0 | 0 | 0 | 1 | 1 | 512 KB | Upper 1/16
|
|
|
|
|
|
|
|
+ * 0 | 0 | 1 | 0 | 0 | 1 MB | Upper 1/8
|
|
|
|
|
|
|
|
+ * 0 | 0 | 1 | 0 | 1 | 2 MB | Upper 1/4
|
|
|
|
|
|
|
|
+ * 0 | 0 | 1 | 1 | 0 | 4 MB | Upper 1/2
|
|
|
|
|
|
|
|
+ * X | X | 1 | 1 | 1 | 8 MB | ALL
|
|
|
|
|
|
|
|
+ *
|
|
|
|
|
|
|
|
+ * Returns negative on errors, 0 on success.
|
|
|
|
|
|
|
|
+ */
|
|
|
|
|
|
|
|
static int stm_lock(struct spi_nor *nor, loff_t ofs, uint64_t len)
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
- struct mtd_info *mtd = nor->mtd;
|
|
|
|
|
|
|
|
- uint32_t offset = ofs;
|
|
|
|
|
|
|
|
- uint8_t status_old, status_new;
|
|
|
|
|
|
|
|
- int ret = 0;
|
|
|
|
|
|
|
|
+ struct mtd_info *mtd = &nor->mtd;
|
|
|
|
|
|
|
|
+ u8 status_old, status_new;
|
|
|
|
|
|
|
|
+ u8 mask = SR_BP2 | SR_BP1 | SR_BP0;
|
|
|
|
|
|
|
|
+ u8 shift = ffs(mask) - 1, pow, val;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
status_old = read_sr(nor);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- if (offset < mtd->size - (mtd->size / 2))
|
|
|
|
|
|
|
|
- status_new = status_old | SR_BP2 | SR_BP1 | SR_BP0;
|
|
|
|
|
|
|
|
- else if (offset < mtd->size - (mtd->size / 4))
|
|
|
|
|
|
|
|
- status_new = (status_old & ~SR_BP0) | SR_BP2 | SR_BP1;
|
|
|
|
|
|
|
|
- else if (offset < mtd->size - (mtd->size / 8))
|
|
|
|
|
|
|
|
- status_new = (status_old & ~SR_BP1) | SR_BP2 | SR_BP0;
|
|
|
|
|
|
|
|
- else if (offset < mtd->size - (mtd->size / 16))
|
|
|
|
|
|
|
|
- status_new = (status_old & ~(SR_BP0 | SR_BP1)) | SR_BP2;
|
|
|
|
|
|
|
|
- else if (offset < mtd->size - (mtd->size / 32))
|
|
|
|
|
|
|
|
- status_new = (status_old & ~SR_BP2) | SR_BP1 | SR_BP0;
|
|
|
|
|
|
|
|
- else if (offset < mtd->size - (mtd->size / 64))
|
|
|
|
|
|
|
|
- status_new = (status_old & ~(SR_BP2 | SR_BP0)) | SR_BP1;
|
|
|
|
|
|
|
|
- else
|
|
|
|
|
|
|
|
- status_new = (status_old & ~(SR_BP2 | SR_BP1)) | SR_BP0;
|
|
|
|
|
|
|
|
+ /* SPI NOR always locks to the end */
|
|
|
|
|
|
|
|
+ if (ofs + len != mtd->size) {
|
|
|
|
|
|
|
|
+ /* Does combined region extend to end? */
|
|
|
|
|
|
|
|
+ if (!stm_is_locked_sr(nor, ofs + len, mtd->size - ofs - len,
|
|
|
|
|
|
|
|
+ status_old))
|
|
|
|
|
|
|
|
+ return -EINVAL;
|
|
|
|
|
|
|
|
+ len = mtd->size - ofs;
|
|
|
|
|
|
|
|
+ }
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+ /*
|
|
|
|
|
|
|
|
+ * Need smallest pow such that:
|
|
|
|
|
|
|
|
+ *
|
|
|
|
|
|
|
|
+ * 1 / (2^pow) <= (len / size)
|
|
|
|
|
|
|
|
+ *
|
|
|
|
|
|
|
|
+ * so (assuming power-of-2 size) we do:
|
|
|
|
|
|
|
|
+ *
|
|
|
|
|
|
|
|
+ * pow = ceil(log2(size / len)) = log2(size) - floor(log2(len))
|
|
|
|
|
|
|
|
+ */
|
|
|
|
|
|
|
|
+ pow = ilog2(mtd->size) - ilog2(len);
|
|
|
|
|
|
|
|
+ val = mask - (pow << shift);
|
|
|
|
|
|
|
|
+ if (val & ~mask)
|
|
|
|
|
|
|
|
+ return -EINVAL;
|
|
|
|
|
|
|
|
+ /* Don't "lock" with no region! */
|
|
|
|
|
|
|
|
+ if (!(val & mask))
|
|
|
|
|
|
|
|
+ return -EINVAL;
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+ status_new = (status_old & ~mask) | val;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Only modify protection if it will not unlock other areas */
|
|
|
|
|
|
|
|
- if ((status_new & (SR_BP2 | SR_BP1 | SR_BP0)) >
|
|
|
|
|
|
|
|
- (status_old & (SR_BP2 | SR_BP1 | SR_BP0))) {
|
|
|
|
|
|
|
|
- write_enable(nor);
|
|
|
|
|
|
|
|
- ret = write_sr(nor, status_new);
|
|
|
|
|
|
|
|
- }
|
|
|
|
|
|
|
|
+ if ((status_new & mask) <= (status_old & mask))
|
|
|
|
|
|
|
|
+ return -EINVAL;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- return ret;
|
|
|
|
|
|
|
|
+ write_enable(nor);
|
|
|
|
|
|
|
|
+ return write_sr(nor, status_new);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
+/*
|
|
|
|
|
|
|
|
+ * Unlock a region of the flash. See stm_lock() for more info
|
|
|
|
|
|
|
|
+ *
|
|
|
|
|
|
|
|
+ * Returns negative on errors, 0 on success.
|
|
|
|
|
|
|
|
+ */
|
|
|
|
|
|
|
|
static int stm_unlock(struct spi_nor *nor, loff_t ofs, uint64_t len)
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
- struct mtd_info *mtd = nor->mtd;
|
|
|
|
|
|
|
|
- uint32_t offset = ofs;
|
|
|
|
|
|
|
|
+ struct mtd_info *mtd = &nor->mtd;
|
|
|
|
|
|
|
|
uint8_t status_old, status_new;
|
|
|
|
|
|
|
|
- int ret = 0;
|
|
|
|
|
|
|
|
+ u8 mask = SR_BP2 | SR_BP1 | SR_BP0;
|
|
|
|
|
|
|
|
+ u8 shift = ffs(mask) - 1, pow, val;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
status_old = read_sr(nor);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- if (offset+len > mtd->size - (mtd->size / 64))
|
|
|
|
|
|
|
|
- status_new = status_old & ~(SR_BP2 | SR_BP1 | SR_BP0);
|
|
|
|
|
|
|
|
- else if (offset+len > mtd->size - (mtd->size / 32))
|
|
|
|
|
|
|
|
- status_new = (status_old & ~(SR_BP2 | SR_BP1)) | SR_BP0;
|
|
|
|
|
|
|
|
- else if (offset+len > mtd->size - (mtd->size / 16))
|
|
|
|
|
|
|
|
- status_new = (status_old & ~(SR_BP2 | SR_BP0)) | SR_BP1;
|
|
|
|
|
|
|
|
- else if (offset+len > mtd->size - (mtd->size / 8))
|
|
|
|
|
|
|
|
- status_new = (status_old & ~SR_BP2) | SR_BP1 | SR_BP0;
|
|
|
|
|
|
|
|
- else if (offset+len > mtd->size - (mtd->size / 4))
|
|
|
|
|
|
|
|
- status_new = (status_old & ~(SR_BP0 | SR_BP1)) | SR_BP2;
|
|
|
|
|
|
|
|
- else if (offset+len > mtd->size - (mtd->size / 2))
|
|
|
|
|
|
|
|
- status_new = (status_old & ~SR_BP1) | SR_BP2 | SR_BP0;
|
|
|
|
|
|
|
|
- else
|
|
|
|
|
|
|
|
- status_new = (status_old & ~SR_BP0) | SR_BP2 | SR_BP1;
|
|
|
|
|
|
|
|
+ /* Cannot unlock; would unlock larger region than requested */
|
|
|
|
|
|
|
|
+ if (stm_is_locked_sr(nor, status_old, ofs - mtd->erasesize,
|
|
|
|
|
|
|
|
+ mtd->erasesize))
|
|
|
|
|
|
|
|
+ return -EINVAL;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- /* Only modify protection if it will not lock other areas */
|
|
|
|
|
|
|
|
- if ((status_new & (SR_BP2 | SR_BP1 | SR_BP0)) <
|
|
|
|
|
|
|
|
- (status_old & (SR_BP2 | SR_BP1 | SR_BP0))) {
|
|
|
|
|
|
|
|
- write_enable(nor);
|
|
|
|
|
|
|
|
- ret = write_sr(nor, status_new);
|
|
|
|
|
|
|
|
+ /*
|
|
|
|
|
|
|
|
+ * Need largest pow such that:
|
|
|
|
|
|
|
|
+ *
|
|
|
|
|
|
|
|
+ * 1 / (2^pow) >= (len / size)
|
|
|
|
|
|
|
|
+ *
|
|
|
|
|
|
|
|
+ * so (assuming power-of-2 size) we do:
|
|
|
|
|
|
|
|
+ *
|
|
|
|
|
|
|
|
+ * pow = floor(log2(size / len)) = log2(size) - ceil(log2(len))
|
|
|
|
|
|
|
|
+ */
|
|
|
|
|
|
|
|
+ pow = ilog2(mtd->size) - order_base_2(mtd->size - (ofs + len));
|
|
|
|
|
|
|
|
+ if (ofs + len == mtd->size) {
|
|
|
|
|
|
|
|
+ val = 0; /* fully unlocked */
|
|
|
|
|
|
|
|
+ } else {
|
|
|
|
|
|
|
|
+ val = mask - (pow << shift);
|
|
|
|
|
|
|
|
+ /* Some power-of-two sizes are not supported */
|
|
|
|
|
|
|
|
+ if (val & ~mask)
|
|
|
|
|
|
|
|
+ return -EINVAL;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- return ret;
|
|
|
|
|
|
|
|
+ status_new = (status_old & ~mask) | val;
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+ /* Only modify protection if it will not lock other areas */
|
|
|
|
|
|
|
|
+ if ((status_new & mask) >= (status_old & mask))
|
|
|
|
|
|
|
|
+ return -EINVAL;
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+ write_enable(nor);
|
|
|
|
|
|
|
|
+ return write_sr(nor, status_new);
|
|
|
|
|
|
|
|
+}
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+/*
|
|
|
|
|
|
|
|
+ * Check if a region of the flash is (completely) locked. See stm_lock() for
|
|
|
|
|
|
|
|
+ * more info.
|
|
|
|
|
|
|
|
+ *
|
|
|
|
|
|
|
|
+ * Returns 1 if entire region is locked, 0 if any portion is unlocked, and
|
|
|
|
|
|
|
|
+ * negative on errors.
|
|
|
|
|
|
|
|
+ */
|
|
|
|
|
|
|
|
+static int stm_is_locked(struct spi_nor *nor, loff_t ofs, uint64_t len)
|
|
|
|
|
|
|
|
+{
|
|
|
|
|
|
|
|
+ int status;
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+ status = read_sr(nor);
|
|
|
|
|
|
|
|
+ if (status < 0)
|
|
|
|
|
|
|
|
+ return status;
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+ return stm_is_locked_sr(nor, ofs, len, status);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static int spi_nor_lock(struct mtd_info *mtd, loff_t ofs, uint64_t len)
|
|
|
|
|
|
|
|
@@ -469,6 +597,21 @@ static int spi_nor_unlock(struct mtd_inf
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
+static int spi_nor_is_locked(struct mtd_info *mtd, loff_t ofs, uint64_t len)
|
|
|
|
|
|
|
|
+{
|
|
|
|
|
|
|
|
+ struct spi_nor *nor = mtd_to_spi_nor(mtd);
|
|
|
|
|
|
|
|
+ int ret;
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+ ret = spi_nor_lock_and_prep(nor, SPI_NOR_OPS_UNLOCK);
|
|
|
|
|
|
|
|
+ if (ret)
|
|
|
|
|
|
|
|
+ return ret;
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+ ret = nor->flash_is_locked(nor, ofs, len);
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+ spi_nor_unlock_and_unprep(nor, SPI_NOR_OPS_LOCK);
|
|
|
|
|
|
|
|
+ return ret;
|
|
|
|
|
|
|
|
+}
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
/* Used when the "_ext_id" is two bytes at most */
|
|
|
|
|
|
|
|
#define INFO(_jedec_id, _ext_id, _sector_size, _n_sectors, _flags) \
|
|
|
|
|
|
|
|
.id = { \
|
|
|
|
|
|
|
|
@@ -585,6 +728,7 @@ static const struct flash_info spi_nor_i
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Micron */
|
|
|
|
|
|
|
|
{ "n25q032", INFO(0x20ba16, 0, 64 * 1024, 64, SPI_NOR_QUAD_READ) },
|
|
|
|
|
|
|
|
+ { "n25q032a", INFO(0x20bb16, 0, 64 * 1024, 64, SPI_NOR_QUAD_READ) },
|
|
|
|
|
|
|
|
{ "n25q064", INFO(0x20ba17, 0, 64 * 1024, 128, SECT_4K | SPI_NOR_QUAD_READ) },
|
|
|
|
|
|
|
|
{ "n25q064a", INFO(0x20bb17, 0, 64 * 1024, 128, SECT_4K | SPI_NOR_QUAD_READ) },
|
|
|
|
|
|
|
|
{ "n25q128a11", INFO(0x20bb18, 0, 64 * 1024, 256, SPI_NOR_QUAD_READ) },
|
|
|
|
|
|
|
|
@@ -618,12 +762,13 @@ static const struct flash_info spi_nor_i
|
|
|
|
|
|
|
|
{ "s25sl016a", INFO(0x010214, 0, 64 * 1024, 32, 0) },
|
|
|
|
|
|
|
|
{ "s25sl032a", INFO(0x010215, 0, 64 * 1024, 64, 0) },
|
|
|
|
|
|
|
|
{ "s25sl064a", INFO(0x010216, 0, 64 * 1024, 128, 0) },
|
|
|
|
|
|
|
|
- { "s25fl008k", INFO(0xef4014, 0, 64 * 1024, 16, SECT_4K) },
|
|
|
|
|
|
|
|
- { "s25fl016k", INFO(0xef4015, 0, 64 * 1024, 32, SECT_4K) },
|
|
|
|
|
|
|
|
+ { "s25fl004k", INFO(0xef4013, 0, 64 * 1024, 8, SECT_4K | SPI_NOR_DUAL_READ | SPI_NOR_QUAD_READ) },
|
|
|
|
|
|
|
|
+ { "s25fl008k", INFO(0xef4014, 0, 64 * 1024, 16, SECT_4K | SPI_NOR_DUAL_READ | SPI_NOR_QUAD_READ) },
|
|
|
|
|
|
|
|
+ { "s25fl016k", INFO(0xef4015, 0, 64 * 1024, 32, SECT_4K | SPI_NOR_DUAL_READ | SPI_NOR_QUAD_READ) },
|
|
|
|
|
|
|
|
{ "s25fl064k", INFO(0xef4017, 0, 64 * 1024, 128, SECT_4K) },
|
|
|
|
|
|
|
|
{ "s25fl132k", INFO(0x014016, 0, 64 * 1024, 64, SECT_4K) },
|
|
|
|
|
|
|
|
{ "s25fl164k", INFO(0x014017, 0, 64 * 1024, 128, SECT_4K) },
|
|
|
|
|
|
|
|
- { "s25fl204k", INFO(0x014013, 0, 64 * 1024, 8, SECT_4K) },
|
|
|
|
|
|
|
|
+ { "s25fl204k", INFO(0x014013, 0, 64 * 1024, 8, SECT_4K | SPI_NOR_DUAL_READ) },
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* SST -- large erase sizes are "overlays", "sectors" are 4K */
|
|
|
|
|
|
|
|
{ "sst25vf040b", INFO(0xbf258d, 0, 64 * 1024, 8, SECT_4K | SST_WRITE) },
|
|
|
|
|
|
|
|
@@ -635,6 +780,7 @@ static const struct flash_info spi_nor_i
|
|
|
|
|
|
|
|
{ "sst25wf010", INFO(0xbf2502, 0, 64 * 1024, 2, SECT_4K | SST_WRITE) },
|
|
|
|
|
|
|
|
{ "sst25wf020", INFO(0xbf2503, 0, 64 * 1024, 4, SECT_4K | SST_WRITE) },
|
|
|
|
|
|
|
|
{ "sst25wf020a", INFO(0x621612, 0, 64 * 1024, 4, SECT_4K) },
|
|
|
|
|
|
|
|
+ { "sst25wf040b", INFO(0x621613, 0, 64 * 1024, 8, SECT_4K) },
|
|
|
|
|
|
|
|
{ "sst25wf040", INFO(0xbf2504, 0, 64 * 1024, 8, SECT_4K | SST_WRITE) },
|
|
|
|
|
|
|
|
{ "sst25wf080", INFO(0xbf2505, 0, 64 * 1024, 16, SECT_4K | SST_WRITE) },
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
@@ -683,10 +829,11 @@ static const struct flash_info spi_nor_i
|
|
|
|
|
|
|
|
{ "w25x16", INFO(0xef3015, 0, 64 * 1024, 32, SECT_4K) },
|
|
|
|
|
|
|
|
{ "w25x32", INFO(0xef3016, 0, 64 * 1024, 64, SECT_4K) },
|
|
|
|
|
|
|
|
{ "w25q32", INFO(0xef4016, 0, 64 * 1024, 64, SECT_4K) },
|
|
|
|
|
|
|
|
- { "w25q32dw", INFO(0xef6016, 0, 64 * 1024, 64, SECT_4K) },
|
|
|
|
|
|
|
|
+ { "w25q32dw", INFO(0xef6016, 0, 64 * 1024, 64, SECT_4K | SPI_NOR_DUAL_READ | SPI_NOR_QUAD_READ) },
|
|
|
|
|
|
|
|
{ "w25x64", INFO(0xef3017, 0, 64 * 1024, 128, SECT_4K) },
|
|
|
|
|
|
|
|
{ "w25q64", INFO(0xef4017, 0, 64 * 1024, 128, SECT_4K) },
|
|
|
|
|
|
|
|
- { "w25q64dw", INFO(0xef6017, 0, 64 * 1024, 128, SECT_4K) },
|
|
|
|
|
|
|
|
+ { "w25q64dw", INFO(0xef6017, 0, 64 * 1024, 128, SECT_4K | SPI_NOR_DUAL_READ | SPI_NOR_QUAD_READ) },
|
|
|
|
|
|
|
|
+ { "w25q128fw", INFO(0xef6018, 0, 64 * 1024, 256, SECT_4K | SPI_NOR_DUAL_READ | SPI_NOR_QUAD_READ) },
|
|
|
|
|
|
|
|
{ "w25q80", INFO(0xef5014, 0, 64 * 1024, 16, SECT_4K) },
|
|
|
|
|
|
|
|
{ "w25q80bl", INFO(0xef4014, 0, 64 * 1024, 16, SECT_4K) },
|
|
|
|
|
|
|
|
{ "w25q128", INFO(0xef4018, 0, 64 * 1024, 256, SECT_4K) },
|
|
|
|
|
|
|
|
@@ -868,8 +1015,7 @@ static int macronix_quad_enable(struct s
|
|
|
|
|
|
|
|
val = read_sr(nor);
|
|
|
|
|
|
|
|
write_enable(nor);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- nor->cmd_buf[0] = val | SR_QUAD_EN_MX;
|
|
|
|
|
|
|
|
- nor->write_reg(nor, SPINOR_OP_WRSR, nor->cmd_buf, 1, 0);
|
|
|
|
|
|
|
|
+ write_sr(nor, val | SR_QUAD_EN_MX);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (spi_nor_wait_till_ready(nor))
|
|
|
|
|
|
|
|
return 1;
|
|
|
|
|
|
|
|
@@ -894,7 +1040,7 @@ static int write_sr_cr(struct spi_nor *n
|
|
|
|
|
|
|
|
nor->cmd_buf[0] = val & 0xff;
|
|
|
|
|
|
|
|
nor->cmd_buf[1] = (val >> 8);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- return nor->write_reg(nor, SPINOR_OP_WRSR, nor->cmd_buf, 2, 0);
|
|
|
|
|
|
|
|
+ return nor->write_reg(nor, SPINOR_OP_WRSR, nor->cmd_buf, 2);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static int spansion_quad_enable(struct spi_nor *nor)
|
|
|
|
|
|
|
|
@@ -936,7 +1082,7 @@ static int micron_quad_enable(struct spi
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* set EVCR, enable quad I/O */
|
|
|
|
|
|
|
|
nor->cmd_buf[0] = val & ~EVCR_QUAD_EN_MICRON;
|
|
|
|
|
|
|
|
- ret = nor->write_reg(nor, SPINOR_OP_WD_EVCR, nor->cmd_buf, 1, 0);
|
|
|
|
|
|
|
|
+ ret = nor->write_reg(nor, SPINOR_OP_WD_EVCR, nor->cmd_buf, 1);
|
|
|
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
|
|
|
dev_err(nor->dev, "error while writing EVCR register\n");
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
@@ -965,14 +1111,14 @@ static int set_quad_mode(struct spi_nor
|
|
|
|
|
|
|
|
int status;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
switch (JEDEC_MFR(info)) {
|
|
|
|
|
|
|
|
- case CFI_MFR_MACRONIX:
|
|
|
|
|
|
|
|
+ case SNOR_MFR_MACRONIX:
|
|
|
|
|
|
|
|
status = macronix_quad_enable(nor);
|
|
|
|
|
|
|
|
if (status) {
|
|
|
|
|
|
|
|
dev_err(nor->dev, "Macronix quad-read not enabled\n");
|
|
|
|
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
return status;
|
|
|
|
|
|
|
|
- case CFI_MFR_ST:
|
|
|
|
|
|
|
|
+ case SNOR_MFR_MICRON:
|
|
|
|
|
|
|
|
status = micron_quad_enable(nor);
|
|
|
|
|
|
|
|
if (status) {
|
|
|
|
|
|
|
|
dev_err(nor->dev, "Micron quad-read not enabled\n");
|
|
|
|
|
|
|
|
@@ -1004,8 +1150,8 @@ int spi_nor_scan(struct spi_nor *nor, co
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
const struct flash_info *info = NULL;
|
|
|
|
|
|
|
|
struct device *dev = nor->dev;
|
|
|
|
|
|
|
|
- struct mtd_info *mtd = nor->mtd;
|
|
|
|
|
|
|
|
- struct device_node *np = dev->of_node;
|
|
|
|
|
|
|
|
+ struct mtd_info *mtd = &nor->mtd;
|
|
|
|
|
|
|
|
+ struct device_node *np = nor->flash_node;
|
|
|
|
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
int i;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
@@ -1048,19 +1194,21 @@ int spi_nor_scan(struct spi_nor *nor, co
|
|
|
|
|
|
|
|
mutex_init(&nor->lock);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
|
|
|
- * Atmel, SST and Intel/Numonyx serial nor tend to power
|
|
|
|
|
|
|
|
- * up with the software protection bits set
|
|
|
|
|
|
|
|
+ * Atmel, SST, Intel/Numonyx, and others serial NOR tend to power up
|
|
|
|
|
|
|
|
+ * with the software protection bits set
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- if (JEDEC_MFR(info) == CFI_MFR_ATMEL ||
|
|
|
|
|
|
|
|
- JEDEC_MFR(info) == CFI_MFR_INTEL ||
|
|
|
|
|
|
|
|
- JEDEC_MFR(info) == CFI_MFR_SST) {
|
|
|
|
|
|
|
|
+ if (JEDEC_MFR(info) == SNOR_MFR_ATMEL ||
|
|
|
|
|
|
|
|
+ JEDEC_MFR(info) == SNOR_MFR_INTEL ||
|
|
|
|
|
|
|
|
+ JEDEC_MFR(info) == SNOR_MFR_SST ||
|
|
|
|
|
|
|
|
+ JEDEC_MFR(info) == SNOR_MFR_WINBOND) {
|
|
|
|
|
|
|
|
write_enable(nor);
|
|
|
|
|
|
|
|
write_sr(nor, 0);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (!mtd->name)
|
|
|
|
|
|
|
|
mtd->name = dev_name(dev);
|
|
|
|
|
|
|
|
+ mtd->priv = nor;
|
|
|
|
|
|
|
|
mtd->type = MTD_NORFLASH;
|
|
|
|
|
|
|
|
mtd->writesize = 1;
|
|
|
|
|
|
|
|
mtd->flags = MTD_CAP_NORFLASH;
|
|
|
|
|
|
|
|
@@ -1068,15 +1216,18 @@ int spi_nor_scan(struct spi_nor *nor, co
|
|
|
|
|
|
|
|
mtd->_erase = spi_nor_erase;
|
|
|
|
|
|
|
|
mtd->_read = spi_nor_read;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- /* nor protection support for STmicro chips */
|
|
|
|
|
|
|
|
- if (JEDEC_MFR(info) == CFI_MFR_ST) {
|
|
|
|
|
|
|
|
+ /* NOR protection support for STmicro/Micron chips and similar */
|
|
|
|
|
|
|
|
+ if (JEDEC_MFR(info) == SNOR_MFR_MICRON ||
|
|
|
|
|
|
|
|
+ JEDEC_MFR(info) == SNOR_MFR_WINBOND) {
|
|
|
|
|
|
|
|
nor->flash_lock = stm_lock;
|
|
|
|
|
|
|
|
nor->flash_unlock = stm_unlock;
|
|
|
|
|
|
|
|
+ nor->flash_is_locked = stm_is_locked;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
- if (nor->flash_lock && nor->flash_unlock) {
|
|
|
|
|
|
|
|
+ if (nor->flash_lock && nor->flash_unlock && nor->flash_is_locked) {
|
|
|
|
|
|
|
|
mtd->_lock = spi_nor_lock;
|
|
|
|
|
|
|
|
mtd->_unlock = spi_nor_unlock;
|
|
|
|
|
|
|
|
+ mtd->_is_locked = spi_nor_is_locked;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* sst nor chips use AAI word program */
|
|
|
|
|
|
|
|
@@ -1163,7 +1314,7 @@ 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 (JEDEC_MFR(info) == CFI_MFR_AMD) {
|
|
|
|
|
|
|
|
+ if (JEDEC_MFR(info) == SNOR_MFR_SPANSION) {
|
|
|
|
|
|
|
|
/* Dedicated 4-byte command set */
|
|
|
|
|
|
|
|
switch (nor->flash_read) {
|
|
|
|
|
|
|
|
case SPI_NOR_QUAD:
|
|
|
|
|
|
|
|
--- a/include/linux/mtd/spi-nor.h
|
|
|
|
|
|
|
|
+++ b/include/linux/mtd/spi-nor.h
|
|
|
|
|
|
|
|
@@ -10,6 +10,23 @@
|
|
|
|
|
|
|
|
#ifndef __LINUX_MTD_SPI_NOR_H
|
|
|
|
|
|
|
|
#define __LINUX_MTD_SPI_NOR_H
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
+#include <linux/bitops.h>
|
|
|
|
|
|
|
|
+#include <linux/mtd/cfi.h>
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
+/*
|
|
|
|
|
|
|
|
+ * Manufacturer IDs
|
|
|
|
|
|
|
|
+ *
|
|
|
|
|
|
|
|
+ * The first byte returned from the flash after sending opcode SPINOR_OP_RDID.
|
|
|
|
|
|
|
|
+ * Sometimes these are the same as CFI IDs, but sometimes they aren't.
|
|
|
|
|
|
|
|
+ */
|
|
|
|
|
|
|
|
+#define SNOR_MFR_ATMEL CFI_MFR_ATMEL
|
|
|
|
|
|
|
|
+#define SNOR_MFR_INTEL CFI_MFR_INTEL
|
|
|
|
|
|
|
|
+#define SNOR_MFR_MICRON CFI_MFR_ST /* ST Micro <--> Micron */
|
|
|
|
|
|
|
|
+#define SNOR_MFR_MACRONIX CFI_MFR_MACRONIX
|
|
|
|
|
|
|
|
+#define SNOR_MFR_SPANSION CFI_MFR_AMD
|
|
|
|
|
|
|
|
+#define SNOR_MFR_SST CFI_MFR_SST
|
|
|
|
|
|
|
|
+#define SNOR_MFR_WINBOND 0xef
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
|
|
|
* Note on opcode nomenclature: some opcodes have a format like
|
|
|
|
|
|
|
|
* SPINOR_OP_FUNCTION{4,}_x_y_z. The numbers x, y, and z stand for the number
|
|
|
|
|
|
|
|
@@ -61,24 +78,24 @@
|
|
|
|
|
|
|
|
#define SPINOR_OP_WD_EVCR 0x61 /* Write EVCR register */
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Status Register bits. */
|
|
|
|
|
|
|
|
-#define SR_WIP 1 /* Write in progress */
|
|
|
|
|
|
|
|
-#define SR_WEL 2 /* Write enable latch */
|
|
|
|
|
|
|
|
+#define SR_WIP BIT(0) /* Write in progress */
|
|
|
|
|
|
|
|
+#define SR_WEL BIT(1) /* Write enable latch */
|
|
|
|
|
|
|
|
/* meaning of other SR_* bits may differ between vendors */
|
|
|
|
|
|
|
|
-#define SR_BP0 4 /* Block protect 0 */
|
|
|
|
|
|
|
|
-#define SR_BP1 8 /* Block protect 1 */
|
|
|
|
|
|
|
|
-#define SR_BP2 0x10 /* Block protect 2 */
|
|
|
|
|
|
|
|
-#define SR_SRWD 0x80 /* SR write protect */
|
|
|
|
|
|
|
|
+#define SR_BP0 BIT(2) /* Block protect 0 */
|
|
|
|
|
|
|
|
+#define SR_BP1 BIT(3) /* Block protect 1 */
|
|
|
|
|
|
|
|
+#define SR_BP2 BIT(4) /* Block protect 2 */
|
|
|
|
|
|
|
|
+#define SR_SRWD BIT(7) /* SR write protect */
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
-#define SR_QUAD_EN_MX 0x40 /* Macronix Quad I/O */
|
|
|
|
|
|
|
|
+#define SR_QUAD_EN_MX BIT(6) /* Macronix Quad I/O */
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Enhanced Volatile Configuration Register bits */
|
|
|
|
|
|
|
|
-#define EVCR_QUAD_EN_MICRON 0x80 /* Micron Quad I/O */
|
|
|
|
|
|
|
|
+#define EVCR_QUAD_EN_MICRON BIT(7) /* Micron Quad I/O */
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Flag Status Register bits */
|
|
|
|
|
|
|
|
-#define FSR_READY 0x80
|
|
|
|
|
|
|
|
+#define FSR_READY BIT(7)
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Configuration Register bits. */
|
|
|
|
|
|
|
|
-#define CR_QUAD_EN_SPAN 0x2 /* Spansion Quad I/O */
|
|
|
|
|
|
|
|
+#define CR_QUAD_EN_SPAN BIT(1) /* Spansion Quad I/O */
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
enum read_mode {
|
|
|
|
|
|
|
|
SPI_NOR_NORMAL = 0,
|
|
|
|
|
|
|
|
@@ -87,33 +104,6 @@ enum read_mode {
|
|
|
|
|
|
|
|
SPI_NOR_QUAD,
|
|
|
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
-/**
|
|
|
|
|
|
|
|
- * struct spi_nor_xfer_cfg - Structure for defining a Serial Flash transfer
|
|
|
|
|
|
|
|
- * @wren: command for "Write Enable", or 0x00 for not required
|
|
|
|
|
|
|
|
- * @cmd: command for operation
|
|
|
|
|
|
|
|
- * @cmd_pins: number of pins to send @cmd (1, 2, 4)
|
|
|
|
|
|
|
|
- * @addr: address for operation
|
|
|
|
|
|
|
|
- * @addr_pins: number of pins to send @addr (1, 2, 4)
|
|
|
|
|
|
|
|
- * @addr_width: number of address bytes
|
|
|
|
|
|
|
|
- * (3,4, or 0 for address not required)
|
|
|
|
|
|
|
|
- * @mode: mode data
|
|
|
|
|
|
|
|
- * @mode_pins: number of pins to send @mode (1, 2, 4)
|
|
|
|
|
|
|
|
- * @mode_cycles: number of mode cycles (0 for mode not required)
|
|
|
|
|
|
|
|
- * @dummy_cycles: number of dummy cycles (0 for dummy not required)
|
|
|
|
|
|
|
|
- */
|
|
|
|
|
|
|
|
-struct spi_nor_xfer_cfg {
|
|
|
|
|
|
|
|
- u8 wren;
|
|
|
|
|
|
|
|
- u8 cmd;
|
|
|
|
|
|
|
|
- u8 cmd_pins;
|
|
|
|
|
|
|
|
- u32 addr;
|
|
|
|
|
|
|
|
- u8 addr_pins;
|
|
|
|
|
|
|
|
- u8 addr_width;
|
|
|
|
|
|
|
|
- u8 mode;
|
|
|
|
|
|
|
|
- u8 mode_pins;
|
|
|
|
|
|
|
|
- u8 mode_cycles;
|
|
|
|
|
|
|
|
- u8 dummy_cycles;
|
|
|
|
|
|
|
|
-};
|
|
|
|
|
|
|
|
-
|
|
|
|
|
|
|
|
#define SPI_NOR_MAX_CMD_SIZE 8
|
|
|
|
|
|
|
|
enum spi_nor_ops {
|
|
|
|
|
|
|
|
SPI_NOR_OPS_READ = 0,
|
|
|
|
|
|
|
|
@@ -127,11 +117,14 @@ enum spi_nor_option_flags {
|
|
|
|
|
|
|
|
SNOR_F_USE_FSR = BIT(0),
|
|
|
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
+struct mtd_info;
|
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
|
|
|
* struct spi_nor - Structure for defining a the SPI NOR layer
|
|
|
|
|
|
|
|
* @mtd: point to a mtd_info structure
|
|
|
|
|
|
|
|
* @lock: the lock for the read/write/erase/lock/unlock operations
|
|
|
|
|
|
|
|
* @dev: point to a spi device, or a spi nor controller device.
|
|
|
|
|
|
|
|
+ * @flash_node: point to a device node describing this flash instance.
|
|
|
|
|
|
|
|
* @page_size: the page size of the SPI NOR
|
|
|
|
|
|
|
|
* @addr_width: number of address bytes
|
|
|
|
|
|
|
|
* @erase_opcode: the opcode for erasing a sector
|
|
|
|
|
|
|
|
@@ -141,28 +134,28 @@ enum spi_nor_option_flags {
|
|
|
|
|
|
|
|
* @flash_read: the mode of the read
|
|
|
|
|
|
|
|
* @sst_write_second: used by the SST write operation
|
|
|
|
|
|
|
|
* @flags: flag options for the current SPI-NOR (SNOR_F_*)
|
|
|
|
|
|
|
|
- * @cfg: used by the read_xfer/write_xfer
|
|
|
|
|
|
|
|
* @cmd_buf: used by the write_reg
|
|
|
|
|
|
|
|
* @prepare: [OPTIONAL] do some preparations for the
|
|
|
|
|
|
|
|
* read/write/erase/lock/unlock operations
|
|
|
|
|
|
|
|
* @unprepare: [OPTIONAL] do some post work after the
|
|
|
|
|
|
|
|
* read/write/erase/lock/unlock operations
|
|
|
|
|
|
|
|
- * @read_xfer: [OPTIONAL] the read fundamental primitive
|
|
|
|
|
|
|
|
- * @write_xfer: [OPTIONAL] the writefundamental primitive
|
|
|
|
|
|
|
|
* @read_reg: [DRIVER-SPECIFIC] read out the register
|
|
|
|
|
|
|
|
* @write_reg: [DRIVER-SPECIFIC] write data to the register
|
|
|
|
|
|
|
|
* @read: [DRIVER-SPECIFIC] read data from the SPI NOR
|
|
|
|
|
|
|
|
* @write: [DRIVER-SPECIFIC] write data to the SPI NOR
|
|
|
|
|
|
|
|
* @erase: [DRIVER-SPECIFIC] erase a sector of the SPI NOR
|
|
|
|
|
|
|
|
* at the offset @offs
|
|
|
|
|
|
|
|
- * @lock: [FLASH-SPECIFIC] lock a region of the SPI NOR
|
|
|
|
|
|
|
|
- * @unlock: [FLASH-SPECIFIC] unlock a region of the SPI NOR
|
|
|
|
|
|
|
|
+ * @flash_lock: [FLASH-SPECIFIC] lock a region of the SPI NOR
|
|
|
|
|
|
|
|
+ * @flash_unlock: [FLASH-SPECIFIC] unlock a region of the SPI NOR
|
|
|
|
|
|
|
|
+ * @flash_is_locked: [FLASH-SPECIFIC] check if a region of the SPI NOR is
|
|
|
|
|
|
|
|
+ * completely locked
|
|
|
|
|
|
|
|
* @priv: the private data
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
struct spi_nor {
|
|
|
|
|
|
|
|
- struct mtd_info *mtd;
|
|
|
|
|
|
|
|
+ struct mtd_info mtd;
|
|
|
|
|
|
|
|
struct mutex lock;
|
|
|
|
|
|
|
|
struct device *dev;
|
|
|
|
|
|
|
|
+ struct device_node *flash_node;
|
|
|
|
|
|
|
|
u32 page_size;
|
|
|
|
|
|
|
|
u8 addr_width;
|
|
|
|
|
|
|
|
u8 erase_opcode;
|
|
|
|
|
|
|
|
@@ -172,18 +165,12 @@ struct spi_nor {
|
|
|
|
|
|
|
|
enum read_mode flash_read;
|
|
|
|
|
|
|
|
bool sst_write_second;
|
|
|
|
|
|
|
|
u32 flags;
|
|
|
|
|
|
|
|
- struct spi_nor_xfer_cfg cfg;
|
|
|
|
|
|
|
|
u8 cmd_buf[SPI_NOR_MAX_CMD_SIZE];
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int (*prepare)(struct spi_nor *nor, enum spi_nor_ops ops);
|
|
|
|
|
|
|
|
void (*unprepare)(struct spi_nor *nor, enum spi_nor_ops ops);
|
|
|
|
|
|
|
|
- int (*read_xfer)(struct spi_nor *nor, struct spi_nor_xfer_cfg *cfg,
|
|
|
|
|
|
|
|
- u8 *buf, size_t len);
|
|
|
|
|
|
|
|
- int (*write_xfer)(struct spi_nor *nor, struct spi_nor_xfer_cfg *cfg,
|
|
|
|
|
|
|
|
- u8 *buf, size_t len);
|
|
|
|
|
|
|
|
int (*read_reg)(struct spi_nor *nor, u8 opcode, u8 *buf, int len);
|
|
|
|
|
|
|
|
- int (*write_reg)(struct spi_nor *nor, u8 opcode, u8 *buf, int len,
|
|
|
|
|
|
|
|
- int write_enable);
|
|
|
|
|
|
|
|
+ int (*write_reg)(struct spi_nor *nor, u8 opcode, u8 *buf, int len);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int (*read)(struct spi_nor *nor, loff_t from,
|
|
|
|
|
|
|
|
size_t len, size_t *retlen, u_char *read_buf);
|
|
|
|
|
|
|
|
@@ -193,6 +180,7 @@ struct spi_nor {
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int (*flash_lock)(struct spi_nor *nor, loff_t ofs, uint64_t len);
|
|
|
|
|
|
|
|
int (*flash_unlock)(struct spi_nor *nor, loff_t ofs, uint64_t len);
|
|
|
|
|
|
|
|
+ int (*flash_is_locked)(struct spi_nor *nor, loff_t ofs, uint64_t len);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void *priv;
|
|
|
|
|
|
|
|
};
|