Commit 6cba6fdf96f13a0533187b9c16608d9ca44add40
1 parent
3163aaa63f
Exists in
master
and in
50 other branches
sf: ops: Add configuration register writing support
This patch provides support to program a flash config register. Configuration register contains the control bits used to configure the different configurations and security features of a device. Signed-off-by: Jagannadha Sutradharudu Teki <jaganna@xilinx.com>
Showing 1 changed file with 24 additions and 0 deletions Inline Diff
drivers/mtd/spi/sf_ops.c
1 | /* | 1 | /* |
2 | * SPI flash operations | 2 | * SPI flash operations |
3 | * | 3 | * |
4 | * Copyright (C) 2008 Atmel Corporation | 4 | * Copyright (C) 2008 Atmel Corporation |
5 | * Copyright (C) 2010 Reinhard Meyer, EMK Elektronik | 5 | * Copyright (C) 2010 Reinhard Meyer, EMK Elektronik |
6 | * Copyright (C) 2013 Jagannadha Sutradharudu Teki, Xilinx Inc. | 6 | * Copyright (C) 2013 Jagannadha Sutradharudu Teki, Xilinx Inc. |
7 | * | 7 | * |
8 | * SPDX-License-Identifier: GPL-2.0+ | 8 | * SPDX-License-Identifier: GPL-2.0+ |
9 | */ | 9 | */ |
10 | 10 | ||
11 | #include <common.h> | 11 | #include <common.h> |
12 | #include <spi.h> | 12 | #include <spi.h> |
13 | #include <spi_flash.h> | 13 | #include <spi_flash.h> |
14 | #include <watchdog.h> | 14 | #include <watchdog.h> |
15 | 15 | ||
16 | #include "sf_internal.h" | 16 | #include "sf_internal.h" |
17 | 17 | ||
18 | static void spi_flash_addr(u32 addr, u8 *cmd) | 18 | static void spi_flash_addr(u32 addr, u8 *cmd) |
19 | { | 19 | { |
20 | /* cmd[0] is actual command */ | 20 | /* cmd[0] is actual command */ |
21 | cmd[1] = addr >> 16; | 21 | cmd[1] = addr >> 16; |
22 | cmd[2] = addr >> 8; | 22 | cmd[2] = addr >> 8; |
23 | cmd[3] = addr >> 0; | 23 | cmd[3] = addr >> 0; |
24 | } | 24 | } |
25 | 25 | ||
26 | int spi_flash_cmd_write_status(struct spi_flash *flash, u8 sr) | 26 | int spi_flash_cmd_write_status(struct spi_flash *flash, u8 sr) |
27 | { | 27 | { |
28 | u8 cmd; | 28 | u8 cmd; |
29 | int ret; | 29 | int ret; |
30 | 30 | ||
31 | cmd = CMD_WRITE_STATUS; | 31 | cmd = CMD_WRITE_STATUS; |
32 | ret = spi_flash_write_common(flash, &cmd, 1, &sr, 1); | 32 | ret = spi_flash_write_common(flash, &cmd, 1, &sr, 1); |
33 | if (ret < 0) { | 33 | if (ret < 0) { |
34 | debug("SF: fail to write status register\n"); | 34 | debug("SF: fail to write status register\n"); |
35 | return ret; | 35 | return ret; |
36 | } | 36 | } |
37 | 37 | ||
38 | return 0; | 38 | return 0; |
39 | } | 39 | } |
40 | 40 | ||
41 | static int spi_flash_cmd_write_config(struct spi_flash *flash, u8 cr) | ||
42 | { | ||
43 | u8 data[2]; | ||
44 | u8 cmd; | ||
45 | int ret; | ||
46 | |||
47 | cmd = CMD_READ_STATUS; | ||
48 | ret = spi_flash_read_common(flash, &cmd, 1, &data[0], 1); | ||
49 | if (ret < 0) { | ||
50 | debug("SF: fail to read status register\n"); | ||
51 | return ret; | ||
52 | } | ||
53 | |||
54 | cmd = CMD_WRITE_STATUS; | ||
55 | data[1] = cr; | ||
56 | ret = spi_flash_write_common(flash, &cmd, 1, &data, 2); | ||
57 | if (ret) { | ||
58 | debug("SF: fail to write config register\n"); | ||
59 | return ret; | ||
60 | } | ||
61 | |||
62 | return 0; | ||
63 | } | ||
64 | |||
41 | #ifdef CONFIG_SPI_FLASH_BAR | 65 | #ifdef CONFIG_SPI_FLASH_BAR |
42 | static int spi_flash_cmd_bankaddr_write(struct spi_flash *flash, u8 bank_sel) | 66 | static int spi_flash_cmd_bankaddr_write(struct spi_flash *flash, u8 bank_sel) |
43 | { | 67 | { |
44 | u8 cmd; | 68 | u8 cmd; |
45 | int ret; | 69 | int ret; |
46 | 70 | ||
47 | if (flash->bank_curr == bank_sel) { | 71 | if (flash->bank_curr == bank_sel) { |
48 | debug("SF: not require to enable bank%d\n", bank_sel); | 72 | debug("SF: not require to enable bank%d\n", bank_sel); |
49 | return 0; | 73 | return 0; |
50 | } | 74 | } |
51 | 75 | ||
52 | cmd = flash->bank_write_cmd; | 76 | cmd = flash->bank_write_cmd; |
53 | ret = spi_flash_write_common(flash, &cmd, 1, &bank_sel, 1); | 77 | ret = spi_flash_write_common(flash, &cmd, 1, &bank_sel, 1); |
54 | if (ret < 0) { | 78 | if (ret < 0) { |
55 | debug("SF: fail to write bank register\n"); | 79 | debug("SF: fail to write bank register\n"); |
56 | return ret; | 80 | return ret; |
57 | } | 81 | } |
58 | flash->bank_curr = bank_sel; | 82 | flash->bank_curr = bank_sel; |
59 | 83 | ||
60 | return 0; | 84 | return 0; |
61 | } | 85 | } |
62 | 86 | ||
63 | static int spi_flash_bank(struct spi_flash *flash, u32 offset) | 87 | static int spi_flash_bank(struct spi_flash *flash, u32 offset) |
64 | { | 88 | { |
65 | u8 bank_sel; | 89 | u8 bank_sel; |
66 | int ret; | 90 | int ret; |
67 | 91 | ||
68 | bank_sel = offset / SPI_FLASH_16MB_BOUN; | 92 | bank_sel = offset / SPI_FLASH_16MB_BOUN; |
69 | 93 | ||
70 | ret = spi_flash_cmd_bankaddr_write(flash, bank_sel); | 94 | ret = spi_flash_cmd_bankaddr_write(flash, bank_sel); |
71 | if (ret) { | 95 | if (ret) { |
72 | debug("SF: fail to set bank%d\n", bank_sel); | 96 | debug("SF: fail to set bank%d\n", bank_sel); |
73 | return ret; | 97 | return ret; |
74 | } | 98 | } |
75 | 99 | ||
76 | return 0; | 100 | return 0; |
77 | } | 101 | } |
78 | #endif | 102 | #endif |
79 | 103 | ||
80 | int spi_flash_cmd_wait_ready(struct spi_flash *flash, unsigned long timeout) | 104 | int spi_flash_cmd_wait_ready(struct spi_flash *flash, unsigned long timeout) |
81 | { | 105 | { |
82 | struct spi_slave *spi = flash->spi; | 106 | struct spi_slave *spi = flash->spi; |
83 | unsigned long timebase; | 107 | unsigned long timebase; |
84 | int ret; | 108 | int ret; |
85 | u8 status; | 109 | u8 status; |
86 | u8 check_status = 0x0; | 110 | u8 check_status = 0x0; |
87 | u8 poll_bit = STATUS_WIP; | 111 | u8 poll_bit = STATUS_WIP; |
88 | u8 cmd = flash->poll_cmd; | 112 | u8 cmd = flash->poll_cmd; |
89 | 113 | ||
90 | if (cmd == CMD_FLAG_STATUS) { | 114 | if (cmd == CMD_FLAG_STATUS) { |
91 | poll_bit = STATUS_PEC; | 115 | poll_bit = STATUS_PEC; |
92 | check_status = poll_bit; | 116 | check_status = poll_bit; |
93 | } | 117 | } |
94 | 118 | ||
95 | ret = spi_xfer(spi, 8, &cmd, NULL, SPI_XFER_BEGIN); | 119 | ret = spi_xfer(spi, 8, &cmd, NULL, SPI_XFER_BEGIN); |
96 | if (ret) { | 120 | if (ret) { |
97 | debug("SF: fail to read %s status register\n", | 121 | debug("SF: fail to read %s status register\n", |
98 | cmd == CMD_READ_STATUS ? "read" : "flag"); | 122 | cmd == CMD_READ_STATUS ? "read" : "flag"); |
99 | return ret; | 123 | return ret; |
100 | } | 124 | } |
101 | 125 | ||
102 | timebase = get_timer(0); | 126 | timebase = get_timer(0); |
103 | do { | 127 | do { |
104 | WATCHDOG_RESET(); | 128 | WATCHDOG_RESET(); |
105 | 129 | ||
106 | ret = spi_xfer(spi, 8, NULL, &status, 0); | 130 | ret = spi_xfer(spi, 8, NULL, &status, 0); |
107 | if (ret) | 131 | if (ret) |
108 | return -1; | 132 | return -1; |
109 | 133 | ||
110 | if ((status & poll_bit) == check_status) | 134 | if ((status & poll_bit) == check_status) |
111 | break; | 135 | break; |
112 | 136 | ||
113 | } while (get_timer(timebase) < timeout); | 137 | } while (get_timer(timebase) < timeout); |
114 | 138 | ||
115 | spi_xfer(spi, 0, NULL, NULL, SPI_XFER_END); | 139 | spi_xfer(spi, 0, NULL, NULL, SPI_XFER_END); |
116 | 140 | ||
117 | if ((status & poll_bit) == check_status) | 141 | if ((status & poll_bit) == check_status) |
118 | return 0; | 142 | return 0; |
119 | 143 | ||
120 | /* Timed out */ | 144 | /* Timed out */ |
121 | debug("SF: time out!\n"); | 145 | debug("SF: time out!\n"); |
122 | return -1; | 146 | return -1; |
123 | } | 147 | } |
124 | 148 | ||
125 | int spi_flash_write_common(struct spi_flash *flash, const u8 *cmd, | 149 | int spi_flash_write_common(struct spi_flash *flash, const u8 *cmd, |
126 | size_t cmd_len, const void *buf, size_t buf_len) | 150 | size_t cmd_len, const void *buf, size_t buf_len) |
127 | { | 151 | { |
128 | struct spi_slave *spi = flash->spi; | 152 | struct spi_slave *spi = flash->spi; |
129 | unsigned long timeout = SPI_FLASH_PROG_TIMEOUT; | 153 | unsigned long timeout = SPI_FLASH_PROG_TIMEOUT; |
130 | int ret; | 154 | int ret; |
131 | 155 | ||
132 | if (buf == NULL) | 156 | if (buf == NULL) |
133 | timeout = SPI_FLASH_PAGE_ERASE_TIMEOUT; | 157 | timeout = SPI_FLASH_PAGE_ERASE_TIMEOUT; |
134 | 158 | ||
135 | ret = spi_claim_bus(flash->spi); | 159 | ret = spi_claim_bus(flash->spi); |
136 | if (ret) { | 160 | if (ret) { |
137 | debug("SF: unable to claim SPI bus\n"); | 161 | debug("SF: unable to claim SPI bus\n"); |
138 | return ret; | 162 | return ret; |
139 | } | 163 | } |
140 | 164 | ||
141 | ret = spi_flash_cmd_write_enable(flash); | 165 | ret = spi_flash_cmd_write_enable(flash); |
142 | if (ret < 0) { | 166 | if (ret < 0) { |
143 | debug("SF: enabling write failed\n"); | 167 | debug("SF: enabling write failed\n"); |
144 | return ret; | 168 | return ret; |
145 | } | 169 | } |
146 | 170 | ||
147 | ret = spi_flash_cmd_write(spi, cmd, cmd_len, buf, buf_len); | 171 | ret = spi_flash_cmd_write(spi, cmd, cmd_len, buf, buf_len); |
148 | if (ret < 0) { | 172 | if (ret < 0) { |
149 | debug("SF: write cmd failed\n"); | 173 | debug("SF: write cmd failed\n"); |
150 | return ret; | 174 | return ret; |
151 | } | 175 | } |
152 | 176 | ||
153 | ret = spi_flash_cmd_wait_ready(flash, timeout); | 177 | ret = spi_flash_cmd_wait_ready(flash, timeout); |
154 | if (ret < 0) { | 178 | if (ret < 0) { |
155 | debug("SF: write %s timed out\n", | 179 | debug("SF: write %s timed out\n", |
156 | timeout == SPI_FLASH_PROG_TIMEOUT ? | 180 | timeout == SPI_FLASH_PROG_TIMEOUT ? |
157 | "program" : "page erase"); | 181 | "program" : "page erase"); |
158 | return ret; | 182 | return ret; |
159 | } | 183 | } |
160 | 184 | ||
161 | spi_release_bus(spi); | 185 | spi_release_bus(spi); |
162 | 186 | ||
163 | return ret; | 187 | return ret; |
164 | } | 188 | } |
165 | 189 | ||
166 | int spi_flash_cmd_erase_ops(struct spi_flash *flash, u32 offset, size_t len) | 190 | int spi_flash_cmd_erase_ops(struct spi_flash *flash, u32 offset, size_t len) |
167 | { | 191 | { |
168 | u32 erase_size; | 192 | u32 erase_size; |
169 | u8 cmd[4]; | 193 | u8 cmd[4]; |
170 | int ret = -1; | 194 | int ret = -1; |
171 | 195 | ||
172 | erase_size = flash->erase_size; | 196 | erase_size = flash->erase_size; |
173 | if (offset % erase_size || len % erase_size) { | 197 | if (offset % erase_size || len % erase_size) { |
174 | debug("SF: Erase offset/length not multiple of erase size\n"); | 198 | debug("SF: Erase offset/length not multiple of erase size\n"); |
175 | return -1; | 199 | return -1; |
176 | } | 200 | } |
177 | 201 | ||
178 | cmd[0] = flash->erase_cmd; | 202 | cmd[0] = flash->erase_cmd; |
179 | while (len) { | 203 | while (len) { |
180 | #ifdef CONFIG_SPI_FLASH_BAR | 204 | #ifdef CONFIG_SPI_FLASH_BAR |
181 | ret = spi_flash_bank(flash, offset); | 205 | ret = spi_flash_bank(flash, offset); |
182 | if (ret < 0) | 206 | if (ret < 0) |
183 | return ret; | 207 | return ret; |
184 | #endif | 208 | #endif |
185 | spi_flash_addr(offset, cmd); | 209 | spi_flash_addr(offset, cmd); |
186 | 210 | ||
187 | debug("SF: erase %2x %2x %2x %2x (%x)\n", cmd[0], cmd[1], | 211 | debug("SF: erase %2x %2x %2x %2x (%x)\n", cmd[0], cmd[1], |
188 | cmd[2], cmd[3], offset); | 212 | cmd[2], cmd[3], offset); |
189 | 213 | ||
190 | ret = spi_flash_write_common(flash, cmd, sizeof(cmd), NULL, 0); | 214 | ret = spi_flash_write_common(flash, cmd, sizeof(cmd), NULL, 0); |
191 | if (ret < 0) { | 215 | if (ret < 0) { |
192 | debug("SF: erase failed\n"); | 216 | debug("SF: erase failed\n"); |
193 | break; | 217 | break; |
194 | } | 218 | } |
195 | 219 | ||
196 | offset += erase_size; | 220 | offset += erase_size; |
197 | len -= erase_size; | 221 | len -= erase_size; |
198 | } | 222 | } |
199 | 223 | ||
200 | return ret; | 224 | return ret; |
201 | } | 225 | } |
202 | 226 | ||
203 | int spi_flash_cmd_write_ops(struct spi_flash *flash, u32 offset, | 227 | int spi_flash_cmd_write_ops(struct spi_flash *flash, u32 offset, |
204 | size_t len, const void *buf) | 228 | size_t len, const void *buf) |
205 | { | 229 | { |
206 | unsigned long byte_addr, page_size; | 230 | unsigned long byte_addr, page_size; |
207 | size_t chunk_len, actual; | 231 | size_t chunk_len, actual; |
208 | u8 cmd[4]; | 232 | u8 cmd[4]; |
209 | int ret = -1; | 233 | int ret = -1; |
210 | 234 | ||
211 | page_size = flash->page_size; | 235 | page_size = flash->page_size; |
212 | 236 | ||
213 | cmd[0] = flash->write_cmd; | 237 | cmd[0] = flash->write_cmd; |
214 | for (actual = 0; actual < len; actual += chunk_len) { | 238 | for (actual = 0; actual < len; actual += chunk_len) { |
215 | #ifdef CONFIG_SPI_FLASH_BAR | 239 | #ifdef CONFIG_SPI_FLASH_BAR |
216 | ret = spi_flash_bank(flash, offset); | 240 | ret = spi_flash_bank(flash, offset); |
217 | if (ret < 0) | 241 | if (ret < 0) |
218 | return ret; | 242 | return ret; |
219 | #endif | 243 | #endif |
220 | byte_addr = offset % page_size; | 244 | byte_addr = offset % page_size; |
221 | chunk_len = min(len - actual, page_size - byte_addr); | 245 | chunk_len = min(len - actual, page_size - byte_addr); |
222 | 246 | ||
223 | if (flash->spi->max_write_size) | 247 | if (flash->spi->max_write_size) |
224 | chunk_len = min(chunk_len, flash->spi->max_write_size); | 248 | chunk_len = min(chunk_len, flash->spi->max_write_size); |
225 | 249 | ||
226 | spi_flash_addr(offset, cmd); | 250 | spi_flash_addr(offset, cmd); |
227 | 251 | ||
228 | debug("PP: 0x%p => cmd = { 0x%02x 0x%02x%02x%02x } chunk_len = %zu\n", | 252 | debug("PP: 0x%p => cmd = { 0x%02x 0x%02x%02x%02x } chunk_len = %zu\n", |
229 | buf + actual, cmd[0], cmd[1], cmd[2], cmd[3], chunk_len); | 253 | buf + actual, cmd[0], cmd[1], cmd[2], cmd[3], chunk_len); |
230 | 254 | ||
231 | ret = spi_flash_write_common(flash, cmd, sizeof(cmd), | 255 | ret = spi_flash_write_common(flash, cmd, sizeof(cmd), |
232 | buf + actual, chunk_len); | 256 | buf + actual, chunk_len); |
233 | if (ret < 0) { | 257 | if (ret < 0) { |
234 | debug("SF: write failed\n"); | 258 | debug("SF: write failed\n"); |
235 | break; | 259 | break; |
236 | } | 260 | } |
237 | 261 | ||
238 | offset += chunk_len; | 262 | offset += chunk_len; |
239 | } | 263 | } |
240 | 264 | ||
241 | return ret; | 265 | return ret; |
242 | } | 266 | } |
243 | 267 | ||
244 | int spi_flash_read_common(struct spi_flash *flash, const u8 *cmd, | 268 | int spi_flash_read_common(struct spi_flash *flash, const u8 *cmd, |
245 | size_t cmd_len, void *data, size_t data_len) | 269 | size_t cmd_len, void *data, size_t data_len) |
246 | { | 270 | { |
247 | struct spi_slave *spi = flash->spi; | 271 | struct spi_slave *spi = flash->spi; |
248 | int ret; | 272 | int ret; |
249 | 273 | ||
250 | ret = spi_claim_bus(flash->spi); | 274 | ret = spi_claim_bus(flash->spi); |
251 | if (ret) { | 275 | if (ret) { |
252 | debug("SF: unable to claim SPI bus\n"); | 276 | debug("SF: unable to claim SPI bus\n"); |
253 | return ret; | 277 | return ret; |
254 | } | 278 | } |
255 | 279 | ||
256 | ret = spi_flash_cmd_read(spi, cmd, cmd_len, data, data_len); | 280 | ret = spi_flash_cmd_read(spi, cmd, cmd_len, data, data_len); |
257 | if (ret < 0) { | 281 | if (ret < 0) { |
258 | debug("SF: read cmd failed\n"); | 282 | debug("SF: read cmd failed\n"); |
259 | return ret; | 283 | return ret; |
260 | } | 284 | } |
261 | 285 | ||
262 | spi_release_bus(spi); | 286 | spi_release_bus(spi); |
263 | 287 | ||
264 | return ret; | 288 | return ret; |
265 | } | 289 | } |
266 | 290 | ||
267 | int spi_flash_cmd_read_ops(struct spi_flash *flash, u32 offset, | 291 | int spi_flash_cmd_read_ops(struct spi_flash *flash, u32 offset, |
268 | size_t len, void *data) | 292 | size_t len, void *data) |
269 | { | 293 | { |
270 | u8 cmd[5], bank_sel = 0; | 294 | u8 cmd[5], bank_sel = 0; |
271 | u32 remain_len, read_len; | 295 | u32 remain_len, read_len; |
272 | int ret = -1; | 296 | int ret = -1; |
273 | 297 | ||
274 | /* Handle memory-mapped SPI */ | 298 | /* Handle memory-mapped SPI */ |
275 | if (flash->memory_map) { | 299 | if (flash->memory_map) { |
276 | ret = spi_claim_bus(flash->spi); | 300 | ret = spi_claim_bus(flash->spi); |
277 | if (ret) { | 301 | if (ret) { |
278 | debug("SF: unable to claim SPI bus\n"); | 302 | debug("SF: unable to claim SPI bus\n"); |
279 | return ret; | 303 | return ret; |
280 | } | 304 | } |
281 | spi_xfer(flash->spi, 0, NULL, NULL, SPI_XFER_MMAP); | 305 | spi_xfer(flash->spi, 0, NULL, NULL, SPI_XFER_MMAP); |
282 | memcpy(data, flash->memory_map + offset, len); | 306 | memcpy(data, flash->memory_map + offset, len); |
283 | spi_xfer(flash->spi, 0, NULL, NULL, SPI_XFER_MMAP_END); | 307 | spi_xfer(flash->spi, 0, NULL, NULL, SPI_XFER_MMAP_END); |
284 | spi_release_bus(flash->spi); | 308 | spi_release_bus(flash->spi); |
285 | return 0; | 309 | return 0; |
286 | } | 310 | } |
287 | 311 | ||
288 | cmd[0] = flash->read_cmd; | 312 | cmd[0] = flash->read_cmd; |
289 | cmd[4] = 0x00; | 313 | cmd[4] = 0x00; |
290 | 314 | ||
291 | while (len) { | 315 | while (len) { |
292 | #ifdef CONFIG_SPI_FLASH_BAR | 316 | #ifdef CONFIG_SPI_FLASH_BAR |
293 | bank_sel = offset / SPI_FLASH_16MB_BOUN; | 317 | bank_sel = offset / SPI_FLASH_16MB_BOUN; |
294 | 318 | ||
295 | ret = spi_flash_cmd_bankaddr_write(flash, bank_sel); | 319 | ret = spi_flash_cmd_bankaddr_write(flash, bank_sel); |
296 | if (ret) { | 320 | if (ret) { |
297 | debug("SF: fail to set bank%d\n", bank_sel); | 321 | debug("SF: fail to set bank%d\n", bank_sel); |
298 | return ret; | 322 | return ret; |
299 | } | 323 | } |
300 | #endif | 324 | #endif |
301 | remain_len = (SPI_FLASH_16MB_BOUN * (bank_sel + 1)) - offset; | 325 | remain_len = (SPI_FLASH_16MB_BOUN * (bank_sel + 1)) - offset; |
302 | if (len < remain_len) | 326 | if (len < remain_len) |
303 | read_len = len; | 327 | read_len = len; |
304 | else | 328 | else |
305 | read_len = remain_len; | 329 | read_len = remain_len; |
306 | 330 | ||
307 | spi_flash_addr(offset, cmd); | 331 | spi_flash_addr(offset, cmd); |
308 | 332 | ||
309 | ret = spi_flash_read_common(flash, cmd, sizeof(cmd), | 333 | ret = spi_flash_read_common(flash, cmd, sizeof(cmd), |
310 | data, read_len); | 334 | data, read_len); |
311 | if (ret < 0) { | 335 | if (ret < 0) { |
312 | debug("SF: read failed\n"); | 336 | debug("SF: read failed\n"); |
313 | break; | 337 | break; |
314 | } | 338 | } |
315 | 339 | ||
316 | offset += read_len; | 340 | offset += read_len; |
317 | len -= read_len; | 341 | len -= read_len; |
318 | data += read_len; | 342 | data += read_len; |
319 | } | 343 | } |
320 | 344 | ||
321 | return ret; | 345 | return ret; |
322 | } | 346 | } |
323 | 347 | ||
324 | #ifdef CONFIG_SPI_FLASH_SST | 348 | #ifdef CONFIG_SPI_FLASH_SST |
325 | static int sst_byte_write(struct spi_flash *flash, u32 offset, const void *buf) | 349 | static int sst_byte_write(struct spi_flash *flash, u32 offset, const void *buf) |
326 | { | 350 | { |
327 | int ret; | 351 | int ret; |
328 | u8 cmd[4] = { | 352 | u8 cmd[4] = { |
329 | CMD_SST_BP, | 353 | CMD_SST_BP, |
330 | offset >> 16, | 354 | offset >> 16, |
331 | offset >> 8, | 355 | offset >> 8, |
332 | offset, | 356 | offset, |
333 | }; | 357 | }; |
334 | 358 | ||
335 | debug("BP[%02x]: 0x%p => cmd = { 0x%02x 0x%06x }\n", | 359 | debug("BP[%02x]: 0x%p => cmd = { 0x%02x 0x%06x }\n", |
336 | spi_w8r8(flash->spi, CMD_READ_STATUS), buf, cmd[0], offset); | 360 | spi_w8r8(flash->spi, CMD_READ_STATUS), buf, cmd[0], offset); |
337 | 361 | ||
338 | ret = spi_flash_cmd_write_enable(flash); | 362 | ret = spi_flash_cmd_write_enable(flash); |
339 | if (ret) | 363 | if (ret) |
340 | return ret; | 364 | return ret; |
341 | 365 | ||
342 | ret = spi_flash_cmd_write(flash->spi, cmd, sizeof(cmd), buf, 1); | 366 | ret = spi_flash_cmd_write(flash->spi, cmd, sizeof(cmd), buf, 1); |
343 | if (ret) | 367 | if (ret) |
344 | return ret; | 368 | return ret; |
345 | 369 | ||
346 | return spi_flash_cmd_wait_ready(flash, SPI_FLASH_PROG_TIMEOUT); | 370 | return spi_flash_cmd_wait_ready(flash, SPI_FLASH_PROG_TIMEOUT); |
347 | } | 371 | } |
348 | 372 | ||
349 | int sst_write_wp(struct spi_flash *flash, u32 offset, size_t len, | 373 | int sst_write_wp(struct spi_flash *flash, u32 offset, size_t len, |
350 | const void *buf) | 374 | const void *buf) |
351 | { | 375 | { |
352 | size_t actual, cmd_len; | 376 | size_t actual, cmd_len; |
353 | int ret; | 377 | int ret; |
354 | u8 cmd[4]; | 378 | u8 cmd[4]; |
355 | 379 | ||
356 | ret = spi_claim_bus(flash->spi); | 380 | ret = spi_claim_bus(flash->spi); |
357 | if (ret) { | 381 | if (ret) { |
358 | debug("SF: Unable to claim SPI bus\n"); | 382 | debug("SF: Unable to claim SPI bus\n"); |
359 | return ret; | 383 | return ret; |
360 | } | 384 | } |
361 | 385 | ||
362 | /* If the data is not word aligned, write out leading single byte */ | 386 | /* If the data is not word aligned, write out leading single byte */ |
363 | actual = offset % 2; | 387 | actual = offset % 2; |
364 | if (actual) { | 388 | if (actual) { |
365 | ret = sst_byte_write(flash, offset, buf); | 389 | ret = sst_byte_write(flash, offset, buf); |
366 | if (ret) | 390 | if (ret) |
367 | goto done; | 391 | goto done; |
368 | } | 392 | } |
369 | offset += actual; | 393 | offset += actual; |
370 | 394 | ||
371 | ret = spi_flash_cmd_write_enable(flash); | 395 | ret = spi_flash_cmd_write_enable(flash); |
372 | if (ret) | 396 | if (ret) |
373 | goto done; | 397 | goto done; |
374 | 398 | ||
375 | cmd_len = 4; | 399 | cmd_len = 4; |
376 | cmd[0] = CMD_SST_AAI_WP; | 400 | cmd[0] = CMD_SST_AAI_WP; |
377 | cmd[1] = offset >> 16; | 401 | cmd[1] = offset >> 16; |
378 | cmd[2] = offset >> 8; | 402 | cmd[2] = offset >> 8; |
379 | cmd[3] = offset; | 403 | cmd[3] = offset; |
380 | 404 | ||
381 | for (; actual < len - 1; actual += 2) { | 405 | for (; actual < len - 1; actual += 2) { |
382 | debug("WP[%02x]: 0x%p => cmd = { 0x%02x 0x%06x }\n", | 406 | debug("WP[%02x]: 0x%p => cmd = { 0x%02x 0x%06x }\n", |
383 | spi_w8r8(flash->spi, CMD_READ_STATUS), buf + actual, | 407 | spi_w8r8(flash->spi, CMD_READ_STATUS), buf + actual, |
384 | cmd[0], offset); | 408 | cmd[0], offset); |
385 | 409 | ||
386 | ret = spi_flash_cmd_write(flash->spi, cmd, cmd_len, | 410 | ret = spi_flash_cmd_write(flash->spi, cmd, cmd_len, |
387 | buf + actual, 2); | 411 | buf + actual, 2); |
388 | if (ret) { | 412 | if (ret) { |
389 | debug("SF: sst word program failed\n"); | 413 | debug("SF: sst word program failed\n"); |
390 | break; | 414 | break; |
391 | } | 415 | } |
392 | 416 | ||
393 | ret = spi_flash_cmd_wait_ready(flash, SPI_FLASH_PROG_TIMEOUT); | 417 | ret = spi_flash_cmd_wait_ready(flash, SPI_FLASH_PROG_TIMEOUT); |
394 | if (ret) | 418 | if (ret) |
395 | break; | 419 | break; |
396 | 420 | ||
397 | cmd_len = 1; | 421 | cmd_len = 1; |
398 | offset += 2; | 422 | offset += 2; |
399 | } | 423 | } |
400 | 424 | ||
401 | if (!ret) | 425 | if (!ret) |
402 | ret = spi_flash_cmd_write_disable(flash); | 426 | ret = spi_flash_cmd_write_disable(flash); |
403 | 427 | ||
404 | /* If there is a single trailing byte, write it out */ | 428 | /* If there is a single trailing byte, write it out */ |
405 | if (!ret && actual != len) | 429 | if (!ret && actual != len) |
406 | ret = sst_byte_write(flash, offset, buf + actual); | 430 | ret = sst_byte_write(flash, offset, buf + actual); |
407 | 431 | ||
408 | done: | 432 | done: |
409 | debug("SF: sst: program %s %zu bytes @ 0x%zx\n", | 433 | debug("SF: sst: program %s %zu bytes @ 0x%zx\n", |
410 | ret ? "failure" : "success", len, offset - actual); | 434 | ret ? "failure" : "success", len, offset - actual); |
411 | 435 | ||
412 | spi_release_bus(flash->spi); | 436 | spi_release_bus(flash->spi); |
413 | return ret; | 437 | return ret; |
414 | } | 438 | } |
415 | #endif | 439 | #endif |
416 | 440 |