From: Yuan Yao <yao.y...@nxp.com>

Some new flash don't support bar register but use 4bytes address to
support exceed 16MB flash size.
So add flash flag:
ADDR_4B
for some flash which support 4bytes address.

Signed-off-by: Yuan Yao <yao.y...@nxp.com>
---
 drivers/mtd/spi/sf_internal.h |  4 +++-
 drivers/mtd/spi/sf_params.c   |  2 +-
 drivers/mtd/spi/spi_flash.c   | 38 +++++++++++++++++++++++++-------------
 include/spi_flash.h           |  1 +
 4 files changed, 30 insertions(+), 15 deletions(-)

diff --git a/drivers/mtd/spi/sf_internal.h b/drivers/mtd/spi/sf_internal.h
index cde4cfb..9ae1549 100644
--- a/drivers/mtd/spi/sf_internal.h
+++ b/drivers/mtd/spi/sf_internal.h
@@ -26,7 +26,8 @@ enum spi_nor_option_flags {
 };
 
 #define SPI_FLASH_3B_ADDR_LEN          3
-#define SPI_FLASH_CMD_LEN              (1 + SPI_FLASH_3B_ADDR_LEN)
+#define SPI_FLASH_4B_ADDR_LEN          4
+#define SPI_FLASH_CMD_MAX_LEN          (1 + SPI_FLASH_4B_ADDR_LEN)
 #define SPI_FLASH_16MB_BOUN            0x1000000
 
 /* CFI Manufacture ID's */
@@ -130,6 +131,7 @@ struct spi_flash_params {
 #define RD_DUAL                        BIT(5)
 #define RD_QUADIO              BIT(6)
 #define RD_DUALIO              BIT(7)
+#define ADDR_4B                        BIT(8)
 #define RD_FULL                        (RD_QUAD | RD_DUAL | RD_QUADIO | 
RD_DUALIO)
 };
 
diff --git a/drivers/mtd/spi/sf_params.c b/drivers/mtd/spi/sf_params.c
index 5b50114..9c26cc8 100644
--- a/drivers/mtd/spi/sf_params.c
+++ b/drivers/mtd/spi/sf_params.c
@@ -68,7 +68,7 @@ const struct spi_flash_params spi_flash_params_table[] = {
        {"S25FL128S_64K",  0x012018, 0x4d01,    64 * 1024,   256, RD_FULL | 
WR_QPP},
        {"S25FL256S_256K", 0x010219, 0x4d00,   256 * 1024,   128, RD_FULL | 
WR_QPP},
        {"S25FL256S_64K",  0x010219, 0x4d01,    64 * 1024,   512, RD_FULL | 
WR_QPP},
-       {"S25FS512S",      0x010220, 0x4D00,   128 * 1024,   512, RD_FULL | 
WR_QPP},
+       {"S25FS512S",      0x010220, 0x4D00,   128 * 1024,   512, RD_FULL | 
WR_QPP | ADDR_4B},
        {"S25FL512S_256K", 0x010220, 0x4d00,   256 * 1024,   256, RD_FULL | 
WR_QPP},
        {"S25FL512S_64K",  0x010220, 0x4d01,    64 * 1024,  1024, RD_FULL | 
WR_QPP},
        {"S25FL512S_512K", 0x010220, 0x4f00,   256 * 1024,   256, RD_FULL | 
WR_QPP},
diff --git a/drivers/mtd/spi/spi_flash.c b/drivers/mtd/spi/spi_flash.c
index 7f6e9ae..487488f 100644
--- a/drivers/mtd/spi/spi_flash.c
+++ b/drivers/mtd/spi/spi_flash.c
@@ -22,12 +22,15 @@
 
 DECLARE_GLOBAL_DATA_PTR;
 
-static void spi_flash_addr(u32 addr, u8 *cmd)
+static void spi_flash_addr(struct spi_flash *flash, u32 addr, u8 *cmd)
 {
        /* cmd[0] is actual command */
-       cmd[1] = addr >> 16;
-       cmd[2] = addr >> 8;
-       cmd[3] = addr >> 0;
+       int i;
+
+       for (i = flash->cmd_len - 1; i > 0; i--) {
+               cmd[i] = addr;
+               addr = addr >> 8;
+       }
 }
 
 static int read_sr(struct spi_flash *flash, u8 *rs)
@@ -327,7 +330,7 @@ int spi_flash_write_common(struct spi_flash *flash, const 
u8 *cmd,
 int spi_flash_cmd_erase_ops(struct spi_flash *flash, u32 offset, size_t len)
 {
        u32 erase_size, erase_addr;
-       u8 cmd[SPI_FLASH_CMD_LEN];
+       u8 cmd[SPI_FLASH_CMD_MAX_LEN];
        int ret = -1;
 
        erase_size = flash->erase_size;
@@ -357,7 +360,7 @@ int spi_flash_cmd_erase_ops(struct spi_flash *flash, u32 
offset, size_t len)
                if (ret < 0)
                        return ret;
 #endif
-               spi_flash_addr(erase_addr, cmd);
+               spi_flash_addr(flash, erase_addr, cmd);
 
                debug("SF: erase %2x %2x %2x %2x (%x)\n", cmd[0], cmd[1],
                      cmd[2], cmd[3], erase_addr);
@@ -382,7 +385,7 @@ int spi_flash_cmd_write_ops(struct spi_flash *flash, u32 
offset,
        unsigned long byte_addr, page_size;
        u32 write_addr;
        size_t chunk_len, actual;
-       u8 cmd[SPI_FLASH_CMD_LEN];
+       u8 cmd[SPI_FLASH_CMD_MAX_LEN];
        int ret = -1;
 
        page_size = flash->page_size;
@@ -415,7 +418,7 @@ int spi_flash_cmd_write_ops(struct spi_flash *flash, u32 
offset,
                        chunk_len = min(chunk_len,
                                        (size_t)spi->max_write_size);
 
-               spi_flash_addr(write_addr, cmd);
+               spi_flash_addr(flash, write_addr, cmd);
 
                debug("SF: 0x%p => cmd = { 0x%02x 0x%02x%02x%02x } chunk_len = 
%zu\n",
                      buf + actual, cmd[0], cmd[1], cmd[2], cmd[3], chunk_len);
@@ -492,7 +495,7 @@ int spi_flash_cmd_read_ops(struct spi_flash *flash, u32 
offset,
                return 0;
        }
 
-       cmdsz = SPI_FLASH_CMD_LEN + flash->dummy_byte;
+       cmdsz = flash->cmd_len + flash->dummy_byte;
        cmd = calloc(1, cmdsz);
        if (!cmd) {
                debug("SF: Failed to allocate cmd\n");
@@ -513,14 +516,18 @@ int spi_flash_cmd_read_ops(struct spi_flash *flash, u32 
offset,
                        return ret;
                bank_sel = flash->bank_curr;
 #endif
-               remain_len = ((SPI_FLASH_16MB_BOUN << flash->shift) *
-                               (bank_sel + 1)) - offset;
+               if (flash->cmd_len == 1 + SPI_FLASH_4B_ADDR_LEN)
+                       remain_len = flash->size - offset;
+               else
+                       remain_len = ((SPI_FLASH_16MB_BOUN << flash->shift) *
+                                       (bank_sel + 1)) - offset;
+
                if (len < remain_len)
                        read_len = len;
                else
                        read_len = remain_len;
 
-               spi_flash_addr(read_addr, cmd);
+               spi_flash_addr(flash, read_addr, cmd);
 
                ret = spi_flash_read_common(flash, cmd, cmdsz, data, read_len);
                if (ret < 0) {
@@ -974,7 +981,7 @@ int spi_flash_decode_fdt(const void *blob, struct spi_flash 
*flash)
 #ifdef CONFIG_SPI_FLASH_SPANSION
 static int spansion_s25fss_disable_4KB_erase(struct spi_slave *spi)
 {
-       u8 cmd[4];
+       u8 cmd[SPI_FLASH_CMD_MAX_LEN];
        u32 offset = 0x800004; /* CR3V register offset */
        u8 cr3v;
        int ret;
@@ -1246,6 +1253,10 @@ int spi_flash_scan(struct spi_flash *flash)
        puts("\n");
 #endif
 
+       if (params->flags & ADDR_4B) {
+               flash->cmd_len = 1 + SPI_FLASH_4B_ADDR_LEN;
+       } else {
+               flash->cmd_len = 1 + SPI_FLASH_3B_ADDR_LEN;
 #ifndef CONFIG_SPI_FLASH_BAR
        if (((flash->dual_flash == SF_SINGLE_FLASH) &&
             (flash->size > SPI_FLASH_16MB_BOUN)) ||
@@ -1255,6 +1266,7 @@ int spi_flash_scan(struct spi_flash *flash)
                puts(" Full access #define CONFIG_SPI_FLASH_BAR\n");
        }
 #endif
+       }
 
        return ret;
 }
diff --git a/include/spi_flash.h b/include/spi_flash.h
index d0ce9e7..56b3252 100644
--- a/include/spi_flash.h
+++ b/include/spi_flash.h
@@ -83,6 +83,7 @@ struct spi_flash {
        u8 read_cmd;
        u8 write_cmd;
        u8 dummy_byte;
+       u8 cmd_len;
 
        void *memory_map;
 
-- 
2.1.0.27.g96db324

_______________________________________________
U-Boot mailing list
U-Boot@lists.denx.de
http://lists.denx.de/mailman/listinfo/u-boot

Reply via email to