GNU Linux-libre 5.10.215-gnu1
[releases.git] / drivers / mtd / spi-nor / sst.c
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright (C) 2005, Intec Automation Inc.
4  * Copyright (C) 2014, Freescale Semiconductor, Inc.
5  */
6
7 #include <linux/mtd/spi-nor.h>
8
9 #include "core.h"
10
11 static const struct flash_info sst_parts[] = {
12         /* SST -- large erase sizes are "overlays", "sectors" are 4K */
13         { "sst25vf040b", INFO(0xbf258d, 0, 64 * 1024,  8,
14                               SECT_4K | SST_WRITE) },
15         { "sst25vf080b", INFO(0xbf258e, 0, 64 * 1024, 16,
16                               SECT_4K | SST_WRITE) },
17         { "sst25vf016b", INFO(0xbf2541, 0, 64 * 1024, 32,
18                               SECT_4K | SST_WRITE) },
19         { "sst25vf032b", INFO(0xbf254a, 0, 64 * 1024, 64,
20                               SECT_4K | SST_WRITE) },
21         { "sst25vf064c", INFO(0xbf254b, 0, 64 * 1024, 128,
22                               SECT_4K | SPI_NOR_4BIT_BP) },
23         { "sst25wf512",  INFO(0xbf2501, 0, 64 * 1024,  1,
24                               SECT_4K | SST_WRITE) },
25         { "sst25wf010",  INFO(0xbf2502, 0, 64 * 1024,  2,
26                               SECT_4K | SST_WRITE) },
27         { "sst25wf020",  INFO(0xbf2503, 0, 64 * 1024,  4,
28                               SECT_4K | SST_WRITE) },
29         { "sst25wf020a", INFO(0x621612, 0, 64 * 1024,  4, SECT_4K) },
30         { "sst25wf040b", INFO(0x621613, 0, 64 * 1024,  8, SECT_4K) },
31         { "sst25wf040",  INFO(0xbf2504, 0, 64 * 1024,  8,
32                               SECT_4K | SST_WRITE) },
33         { "sst25wf080",  INFO(0xbf2505, 0, 64 * 1024, 16,
34                               SECT_4K | SST_WRITE) },
35         { "sst26wf016b", INFO(0xbf2651, 0, 64 * 1024, 32,
36                               SECT_4K | SPI_NOR_DUAL_READ |
37                               SPI_NOR_QUAD_READ) },
38         { "sst26vf016b", INFO(0xbf2641, 0, 64 * 1024, 32,
39                               SECT_4K | SPI_NOR_DUAL_READ) },
40         { "sst26vf064b", INFO(0xbf2643, 0, 64 * 1024, 128,
41                               SECT_4K | SPI_NOR_DUAL_READ |
42                               SPI_NOR_QUAD_READ) },
43 };
44
45 static int sst_write(struct mtd_info *mtd, loff_t to, size_t len,
46                      size_t *retlen, const u_char *buf)
47 {
48         struct spi_nor *nor = mtd_to_spi_nor(mtd);
49         size_t actual = 0;
50         int ret;
51
52         dev_dbg(nor->dev, "to 0x%08x, len %zd\n", (u32)to, len);
53
54         ret = spi_nor_lock_and_prep(nor);
55         if (ret)
56                 return ret;
57
58         ret = spi_nor_write_enable(nor);
59         if (ret)
60                 goto out;
61
62         nor->sst_write_second = false;
63
64         /* Start write from odd address. */
65         if (to % 2) {
66                 nor->program_opcode = SPINOR_OP_BP;
67
68                 /* write one byte. */
69                 ret = spi_nor_write_data(nor, to, 1, buf);
70                 if (ret < 0)
71                         goto out;
72                 WARN(ret != 1, "While writing 1 byte written %i bytes\n", ret);
73                 ret = spi_nor_wait_till_ready(nor);
74                 if (ret)
75                         goto out;
76
77                 to++;
78                 actual++;
79         }
80
81         /* Write out most of the data here. */
82         for (; actual < len - 1; actual += 2) {
83                 nor->program_opcode = SPINOR_OP_AAI_WP;
84
85                 /* write two bytes. */
86                 ret = spi_nor_write_data(nor, to, 2, buf + actual);
87                 if (ret < 0)
88                         goto out;
89                 WARN(ret != 2, "While writing 2 bytes written %i bytes\n", ret);
90                 ret = spi_nor_wait_till_ready(nor);
91                 if (ret)
92                         goto out;
93                 to += 2;
94                 nor->sst_write_second = true;
95         }
96         nor->sst_write_second = false;
97
98         ret = spi_nor_write_disable(nor);
99         if (ret)
100                 goto out;
101
102         ret = spi_nor_wait_till_ready(nor);
103         if (ret)
104                 goto out;
105
106         /* Write out trailing byte if it exists. */
107         if (actual != len) {
108                 ret = spi_nor_write_enable(nor);
109                 if (ret)
110                         goto out;
111
112                 nor->program_opcode = SPINOR_OP_BP;
113                 ret = spi_nor_write_data(nor, to, 1, buf + actual);
114                 if (ret < 0)
115                         goto out;
116                 WARN(ret != 1, "While writing 1 byte written %i bytes\n", ret);
117                 ret = spi_nor_wait_till_ready(nor);
118                 if (ret)
119                         goto out;
120
121                 actual += 1;
122
123                 ret = spi_nor_write_disable(nor);
124         }
125 out:
126         *retlen += actual;
127         spi_nor_unlock_and_unprep(nor);
128         return ret;
129 }
130
131 static void sst_default_init(struct spi_nor *nor)
132 {
133         nor->flags |= SNOR_F_HAS_LOCK;
134 }
135
136 static void sst_post_sfdp_fixups(struct spi_nor *nor)
137 {
138         if (nor->info->flags & SST_WRITE)
139                 nor->mtd._write = sst_write;
140 }
141
142 static const struct spi_nor_fixups sst_fixups = {
143         .default_init = sst_default_init,
144         .post_sfdp = sst_post_sfdp_fixups,
145 };
146
147 const struct spi_nor_manufacturer spi_nor_sst = {
148         .name = "sst",
149         .parts = sst_parts,
150         .nparts = ARRAY_SIZE(sst_parts),
151         .fixups = &sst_fixups,
152 };