cfi.c revision 1.5 1 1.5 cliff /* $NetBSD: cfi.c,v 1.5 2011/07/23 07:17:34 cliff Exp $ */
2 1.3 cliff /*-
3 1.3 cliff * Copyright (c) 2011 The NetBSD Foundation, Inc.
4 1.3 cliff * All rights reserved.
5 1.3 cliff *
6 1.3 cliff * This code is derived from software contributed to The NetBSD Foundation
7 1.3 cliff * by Cliff Neighbors.
8 1.3 cliff *
9 1.3 cliff * Redistribution and use in source and binary forms, with or without
10 1.3 cliff * modification, are permitted provided that the following conditions
11 1.3 cliff * are met:
12 1.3 cliff * 1. Redistributions of source code must retain the above copyright
13 1.3 cliff * notice, this list of conditions and the following disclaimer.
14 1.3 cliff * 2. Redistributions in binary form must reproduce the above copyright
15 1.3 cliff * notice, this list of conditions and the following disclaimer in the
16 1.3 cliff * documentation and/or other materials provided with the distribution.
17 1.3 cliff *
18 1.3 cliff * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
19 1.3 cliff * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
20 1.3 cliff * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
21 1.3 cliff * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
22 1.3 cliff * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23 1.3 cliff * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24 1.3 cliff * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25 1.3 cliff * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26 1.3 cliff * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27 1.3 cliff * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28 1.3 cliff * POSSIBILITY OF SUCH DAMAGE.
29 1.3 cliff */
30 1.1 cliff
31 1.4 cliff #include "opt_flash.h"
32 1.1 cliff #include "opt_nor.h"
33 1.4 cliff #include "opt_cfi.h"
34 1.1 cliff
35 1.1 cliff #include <sys/cdefs.h>
36 1.5 cliff __KERNEL_RCSID(0, "$NetBSD: cfi.c,v 1.5 2011/07/23 07:17:34 cliff Exp $");
37 1.1 cliff
38 1.1 cliff #include <sys/param.h>
39 1.1 cliff #include <sys/systm.h>
40 1.1 cliff #include <sys/cdefs.h>
41 1.1 cliff #include <sys/device.h>
42 1.1 cliff #include <sys/endian.h>
43 1.1 cliff
44 1.2 dyoung #include <sys/bus.h>
45 1.1 cliff
46 1.1 cliff #include <dev/nor/nor.h>
47 1.1 cliff #include <dev/nor/cfi.h>
48 1.1 cliff #include <dev/nor/cfi_0002.h>
49 1.1 cliff
50 1.1 cliff
51 1.1 cliff static bool cfi_chip_query(struct cfi * const);
52 1.1 cliff static int cfi_scan_media(device_t self, struct nor_chip *chip);
53 1.1 cliff static void cfi_init(device_t);
54 1.1 cliff static void cfi_select(device_t, bool);
55 1.1 cliff static void cfi_read_1(device_t, flash_off_t, uint8_t *);
56 1.1 cliff static void cfi_read_2(device_t, flash_off_t, uint16_t *);
57 1.1 cliff static void cfi_read_4(device_t, flash_off_t, uint32_t *);
58 1.1 cliff static void cfi_read_buf_1(device_t, flash_off_t, uint8_t *, size_t);
59 1.1 cliff static void cfi_read_buf_2(device_t, flash_off_t, uint16_t *, size_t);
60 1.1 cliff static void cfi_read_buf_4(device_t, flash_off_t, uint32_t *, size_t);
61 1.1 cliff static void cfi_write_1(device_t, flash_off_t, uint8_t);
62 1.1 cliff static void cfi_write_2(device_t, flash_off_t, uint16_t);
63 1.1 cliff static void cfi_write_4(device_t, flash_off_t, uint32_t);
64 1.1 cliff static void cfi_write_buf_1(device_t, flash_off_t, const uint8_t *, size_t);
65 1.1 cliff static void cfi_write_buf_2(device_t, flash_off_t, const uint16_t *, size_t);
66 1.1 cliff static void cfi_write_buf_4(device_t, flash_off_t, const uint32_t *, size_t);
67 1.4 cliff static void cfi_jedec_id_1(struct cfi * const );
68 1.4 cliff static void cfi_jedec_id_2(struct cfi * const );
69 1.4 cliff static void cfi_jedec_id_4(struct cfi * const );
70 1.1 cliff static bool cfi_jedec_id(struct cfi * const);
71 1.4 cliff static bool cfi_emulate(struct cfi * const);
72 1.4 cliff static const struct cfi_jedec_tab * cfi_jedec_search(struct cfi *);
73 1.4 cliff static void cfi_jedec_fill(struct cfi * const,
74 1.4 cliff const struct cfi_jedec_tab *);
75 1.4 cliff #if defined(CFI_DEBUG_JEDEC) || defined(CFI_DEBUG_QRY)
76 1.4 cliff static void cfi_hexdump(flash_off_t, void * const, u_int, u_int);
77 1.4 cliff #endif
78 1.4 cliff
79 1.1 cliff
80 1.1 cliff
81 1.1 cliff /*
82 1.1 cliff * NOTE these opmode tables are informed by "Table 1. CFI Query Read"
83 1.1 cliff * in Intel "Common Flash Interface (CFI) and Command Sets"
84 1.1 cliff * Application Note 646, April 2000
85 1.1 cliff *
86 1.5 cliff * Assume the byte order of the flash (and of the signature there)
87 1.5 cliff * is the same as host byte order. The Intel App. Note describes the
88 1.5 cliff * little endian variant.
89 1.1 cliff *
90 1.1 cliff * XXX down-sized, interleaved & multi-chip opmodes not yet supported
91 1.1 cliff */
92 1.1 cliff
93 1.5 cliff #if BYTE_ORDER == BIG_ENDIAN
94 1.5 cliff /* BIG ENDIAN host */
95 1.1 cliff /* 1-byte access */
96 1.1 cliff static const struct cfi_opmodes cfi_opmodes_1[] = {
97 1.1 cliff { 0, 0, 0, 0x10, 3, "QRY", "x8 device operating in 8-bit mode" },
98 1.1 cliff };
99 1.1 cliff
100 1.1 cliff /* 2-byte access */
101 1.1 cliff static const struct cfi_opmodes cfi_opmodes_2[] = {
102 1.1 cliff { 1, 1, 0, 0x20, 6, "\0Q\0R\0Y",
103 1.1 cliff "x16 device operating in 16-bit mode" },
104 1.1 cliff };
105 1.1 cliff
106 1.1 cliff /* 4-byte access */
107 1.1 cliff static const struct cfi_opmodes cfi_opmodes_4[] = {
108 1.1 cliff { 2, 2, 0, 0x40, 12, "\0\0\0Q\0\0\0R\0\0\0Y",
109 1.1 cliff "x32 device operating in 32-bit mode" },
110 1.1 cliff };
111 1.5 cliff #else
112 1.5 cliff /* LITTLE ENDIAN host */
113 1.5 cliff /* 1-byte access */
114 1.5 cliff static const struct cfi_opmodes cfi_opmodes_1[] = {
115 1.5 cliff { 0, 0, 0, 0x10, 3, "QRY", "x8 device operating in 8-bit mode" },
116 1.5 cliff };
117 1.5 cliff
118 1.5 cliff /* 2-byte access */
119 1.5 cliff static const struct cfi_opmodes cfi_opmodes_2[] = {
120 1.5 cliff { 1, 1, 0, 0x20, 6, "Q\0R\0Y\0",
121 1.5 cliff "x16 device operating in 16-bit mode" },
122 1.5 cliff };
123 1.5 cliff
124 1.5 cliff /* 4-byte access */
125 1.5 cliff static const struct cfi_opmodes cfi_opmodes_4[] = {
126 1.5 cliff { 2, 2, 0, 0x40, 12, "Q\0\0\0R\0\0\0Y\0\0\0",
127 1.5 cliff "x32 device operating in 32-bit mode" },
128 1.5 cliff };
129 1.5 cliff #endif
130 1.1 cliff
131 1.1 cliff
132 1.4 cliff #define LOG2_64K 16
133 1.4 cliff #define LOG2_128K 17
134 1.4 cliff #define LOG2_256K 18
135 1.4 cliff #define LOG2_512K 19
136 1.4 cliff #define LOG2_1M 20
137 1.4 cliff #define LOG2_2M 21
138 1.4 cliff #define LOG2_4M 22
139 1.4 cliff #define LOG2_8M 23
140 1.4 cliff #define LOG2_16M 24
141 1.4 cliff #define LOG2_32M 25
142 1.4 cliff #define LOG2_64M 26
143 1.4 cliff #define LOG2_128M 27
144 1.4 cliff #define LOG2_256M 28
145 1.4 cliff #define LOG2_512M 29
146 1.4 cliff #define LOG2_1G 30
147 1.4 cliff #define LOG2_2G 31
148 1.4 cliff const struct cfi_jedec_tab cfi_jedec_tab[] = {
149 1.4 cliff {
150 1.4 cliff .jt_name = "Pm39LV512",
151 1.4 cliff .jt_mid = 0x9d,
152 1.4 cliff .jt_did = 0x1b,
153 1.4 cliff .jt_id_pri = 0, /* XXX */
154 1.4 cliff .jt_id_alt = 0, /* XXX */
155 1.4 cliff .jt_device_size = LOG2_64K,
156 1.4 cliff .jt_interface_code_desc = CFI_IFCODE_X8,
157 1.4 cliff .jt_erase_blk_regions = 1,
158 1.4 cliff .jt_erase_blk_info = {
159 1.4 cliff { 4096/256, (64/4)-1 },
160 1.4 cliff },
161 1.4 cliff .jt_write_word_time_typ = 40,
162 1.4 cliff .jt_write_nbyte_time_typ = 0,
163 1.4 cliff .jt_erase_blk_time_typ = 55,
164 1.4 cliff .jt_erase_chip_time_typ = 55,
165 1.4 cliff .jt_write_word_time_max = 1,
166 1.4 cliff .jt_write_nbyte_time_max = 0,
167 1.4 cliff .jt_erase_blk_time_max = 1,
168 1.4 cliff .jt_erase_chip_time_max = 1,
169 1.4 cliff .jt_opmode = &cfi_opmodes_1[0],
170 1.4 cliff },
171 1.4 cliff {
172 1.4 cliff .jt_name = "Pm39LV010",
173 1.4 cliff .jt_mid = 0x9d,
174 1.4 cliff .jt_did = 0x1c,
175 1.4 cliff .jt_id_pri = 0, /* XXX */
176 1.4 cliff .jt_id_alt = 0, /* XXX */
177 1.4 cliff .jt_device_size = LOG2_128K,
178 1.4 cliff .jt_interface_code_desc = CFI_IFCODE_X8,
179 1.4 cliff .jt_erase_blk_regions = 1,
180 1.4 cliff .jt_erase_blk_info = {
181 1.4 cliff { 4096/256, (128/4)-1 },
182 1.4 cliff },
183 1.4 cliff .jt_write_word_time_typ = 40,
184 1.4 cliff .jt_write_nbyte_time_typ = 0,
185 1.4 cliff .jt_erase_blk_time_typ = 55,
186 1.4 cliff .jt_erase_chip_time_typ = 55,
187 1.4 cliff .jt_write_word_time_max = 1,
188 1.4 cliff .jt_write_nbyte_time_max = 0,
189 1.4 cliff .jt_erase_blk_time_max = 1,
190 1.4 cliff .jt_erase_chip_time_max = 1,
191 1.4 cliff .jt_opmode = &cfi_opmodes_1[0],
192 1.4 cliff },
193 1.4 cliff };
194 1.4 cliff
195 1.4 cliff
196 1.1 cliff const struct nor_interface nor_interface_cfi = {
197 1.1 cliff .scan_media = cfi_scan_media,
198 1.1 cliff .init = cfi_init,
199 1.1 cliff .select = cfi_select,
200 1.1 cliff .read_1 = cfi_read_1,
201 1.1 cliff .read_2 = cfi_read_2,
202 1.1 cliff .read_4 = cfi_read_4,
203 1.1 cliff .read_buf_1 = cfi_read_buf_1,
204 1.1 cliff .read_buf_2 = cfi_read_buf_2,
205 1.1 cliff .read_buf_4 = cfi_read_buf_4,
206 1.1 cliff .write_1 = cfi_write_1,
207 1.1 cliff .write_2 = cfi_write_2,
208 1.1 cliff .write_4 = cfi_write_4,
209 1.1 cliff .write_buf_1 = cfi_write_buf_1,
210 1.1 cliff .write_buf_2 = cfi_write_buf_2,
211 1.1 cliff .write_buf_4 = cfi_write_buf_4,
212 1.1 cliff .read_page = NULL, /* cmdset */
213 1.1 cliff .program_page = NULL, /* cmdset */
214 1.1 cliff .busy = NULL,
215 1.1 cliff .private = NULL,
216 1.1 cliff .access_width = -1,
217 1.1 cliff .part_info = NULL,
218 1.1 cliff .part_num = -1,
219 1.1 cliff };
220 1.1 cliff
221 1.1 cliff
222 1.1 cliff /* only data[7..0] are used regardless of chip width */
223 1.1 cliff #define cfi_unpack_1(n) ((n) & 0xff)
224 1.1 cliff
225 1.1 cliff /* construct (arbitrarily big endian) uint16_t */
226 1.1 cliff #define cfi_unpack_2(b0, b1) \
227 1.1 cliff ((cfi_unpack_1(b1) << 8) | cfi_unpack_1(b0))
228 1.1 cliff
229 1.1 cliff /* construct (arbitrarily) big endian uint32_t */
230 1.1 cliff #define cfi_unpack_4(b0, b1, b2, b3) \
231 1.1 cliff ((cfi_unpack_1(b3) << 24) | \
232 1.1 cliff (cfi_unpack_1(b2) << 16) | \
233 1.1 cliff (cfi_unpack_1(b1) << 8) | \
234 1.1 cliff (cfi_unpack_1(b0)))
235 1.1 cliff
236 1.1 cliff #define cfi_unpack_qry(qryp, data) \
237 1.1 cliff do { \
238 1.1 cliff (qryp)->qry[0] = cfi_unpack_1(data[0x10]); \
239 1.1 cliff (qryp)->qry[1] = cfi_unpack_1(data[0x11]); \
240 1.1 cliff (qryp)->qry[2] = cfi_unpack_1(data[0x12]); \
241 1.1 cliff (qryp)->id_pri = be16toh(cfi_unpack_2(data[0x13], data[0x14])); \
242 1.1 cliff (qryp)->addr_pri = \
243 1.1 cliff be16toh(cfi_unpack_2(data[0x15], data[0x16])); \
244 1.1 cliff (qryp)->id_alt = be16toh(cfi_unpack_2(data[0x17], data[0x18])); \
245 1.1 cliff (qryp)->addr_alt = \
246 1.1 cliff be16toh(cfi_unpack_2(data[0x19], data[0x1a])); \
247 1.1 cliff (qryp)->vcc_min = cfi_unpack_1(data[0x1b]); \
248 1.1 cliff (qryp)->vcc_max = cfi_unpack_1(data[0x1c]); \
249 1.1 cliff (qryp)->vpp_min = cfi_unpack_1(data[0x1d]); \
250 1.1 cliff (qryp)->vpp_max = cfi_unpack_1(data[0x1e]); \
251 1.1 cliff (qryp)->write_word_time_typ = cfi_unpack_1(data[0x1f]); \
252 1.1 cliff (qryp)->write_nbyte_time_typ = cfi_unpack_1(data[0x20]); \
253 1.1 cliff (qryp)->erase_blk_time_typ = cfi_unpack_1(data[0x21]); \
254 1.4 cliff (qryp)->erase_chip_time_typ = cfi_unpack_1(data[0x22]); \
255 1.1 cliff (qryp)->write_word_time_max = cfi_unpack_1(data[0x23]); \
256 1.1 cliff (qryp)->write_nbyte_time_max = cfi_unpack_1(data[0x24]); \
257 1.1 cliff (qryp)->erase_blk_time_max = cfi_unpack_1(data[0x25]); \
258 1.4 cliff (qryp)->erase_chip_time_max = cfi_unpack_1(data[0x26]); \
259 1.1 cliff (qryp)->device_size = cfi_unpack_1(data[0x27]); \
260 1.1 cliff (qryp)->interface_code_desc = \
261 1.1 cliff be16toh(cfi_unpack_2(data[0x28], data[0x29])); \
262 1.1 cliff (qryp)->write_nbyte_size_max = \
263 1.1 cliff be16toh(cfi_unpack_2(data[0x2a], data[0x2b])); \
264 1.1 cliff (qryp)->erase_blk_regions = cfi_unpack_1(data[0x2c]); \
265 1.1 cliff u_int _i = 0x2d; \
266 1.1 cliff const u_int _n = (qryp)->erase_blk_regions; \
267 1.1 cliff KASSERT(_n <= 4); \
268 1.1 cliff for (u_int _r = 0; _r < _n; _r++, _i+=4) { \
269 1.1 cliff (qryp)->erase_blk_info[_r].y = \
270 1.1 cliff be32toh(cfi_unpack_2(data[_i+0], data[_i+1])); \
271 1.1 cliff (qryp)->erase_blk_info[_r].z = \
272 1.1 cliff be32toh(cfi_unpack_2(data[_i+2], data[_i+3])); \
273 1.1 cliff } \
274 1.1 cliff } while (0)
275 1.1 cliff
276 1.1 cliff #define cfi_unpack_pri_0002(qryp, data) \
277 1.1 cliff do { \
278 1.1 cliff (qryp)->pri.cmd_0002.pri[0] = cfi_unpack_1(data[0x00]); \
279 1.1 cliff (qryp)->pri.cmd_0002.pri[1] = cfi_unpack_1(data[0x01]); \
280 1.1 cliff (qryp)->pri.cmd_0002.pri[2] = cfi_unpack_1(data[0x02]); \
281 1.1 cliff (qryp)->pri.cmd_0002.version_maj = cfi_unpack_1(data[0x03]); \
282 1.1 cliff (qryp)->pri.cmd_0002.version_min = cfi_unpack_1(data[0x04]); \
283 1.1 cliff (qryp)->pri.cmd_0002.asupt = cfi_unpack_1(data[0x05]); \
284 1.1 cliff (qryp)->pri.cmd_0002.erase_susp = cfi_unpack_1(data[0x06]); \
285 1.1 cliff (qryp)->pri.cmd_0002.sector_prot = cfi_unpack_1(data[0x07]); \
286 1.1 cliff (qryp)->pri.cmd_0002.tmp_sector_unprot = \
287 1.1 cliff cfi_unpack_1(data[0x08]); \
288 1.1 cliff (qryp)->pri.cmd_0002.sector_prot_scheme = \
289 1.1 cliff cfi_unpack_1(data[0x09]); \
290 1.1 cliff (qryp)->pri.cmd_0002.simul_op = cfi_unpack_1(data[0x0a]); \
291 1.1 cliff (qryp)->pri.cmd_0002.burst_mode_type = cfi_unpack_1(data[0x0b]);\
292 1.1 cliff (qryp)->pri.cmd_0002.page_mode_type = cfi_unpack_1(data[0x0c]); \
293 1.1 cliff (qryp)->pri.cmd_0002.acc_min = cfi_unpack_1(data[0x0d]); \
294 1.1 cliff (qryp)->pri.cmd_0002.acc_max = cfi_unpack_1(data[0x0e]); \
295 1.1 cliff (qryp)->pri.cmd_0002.wp_prot = cfi_unpack_1(data[0x0f]); \
296 1.1 cliff /* XXX 1.3 stops here */ \
297 1.1 cliff (qryp)->pri.cmd_0002.prog_susp = cfi_unpack_1(data[0x10]); \
298 1.1 cliff (qryp)->pri.cmd_0002.unlock_bypass = cfi_unpack_1(data[0x11]); \
299 1.1 cliff (qryp)->pri.cmd_0002.sss_size = cfi_unpack_1(data[0x12]); \
300 1.1 cliff (qryp)->pri.cmd_0002.soft_feat = cfi_unpack_1(data[0x13]); \
301 1.1 cliff (qryp)->pri.cmd_0002.page_size = cfi_unpack_1(data[0x14]); \
302 1.1 cliff (qryp)->pri.cmd_0002.erase_susp_time_max = \
303 1.1 cliff cfi_unpack_1(data[0x15]); \
304 1.1 cliff (qryp)->pri.cmd_0002.prog_susp_time_max = \
305 1.1 cliff cfi_unpack_1(data[0x16]); \
306 1.1 cliff (qryp)->pri.cmd_0002.embhwrst_time_max = \
307 1.1 cliff cfi_unpack_1(data[0x38]); \
308 1.1 cliff (qryp)->pri.cmd_0002.hwrst_time_max = \
309 1.1 cliff cfi_unpack_1(data[0x39]); \
310 1.1 cliff } while (0)
311 1.1 cliff
312 1.1 cliff #define CFI_QRY_UNPACK_COMMON(cfi, data, type, found) \
313 1.1 cliff do { \
314 1.1 cliff struct cfi_query_data * const qryp = &cfi->cfi_qry_data; \
315 1.1 cliff \
316 1.1 cliff memset(qryp, 0, sizeof(*qryp)); \
317 1.1 cliff cfi_unpack_qry(qryp, data); \
318 1.1 cliff \
319 1.1 cliff switch (qryp->id_pri) { \
320 1.1 cliff case 0x0002: \
321 1.1 cliff if ((cfi_unpack_1(data[qryp->addr_pri + 0]) == 'P') && \
322 1.1 cliff (cfi_unpack_1(data[qryp->addr_pri + 1]) == 'R') && \
323 1.1 cliff (cfi_unpack_1(data[qryp->addr_pri + 2]) == 'I')) { \
324 1.1 cliff type *pri_data = &data[qryp->addr_pri]; \
325 1.1 cliff cfi_unpack_pri_0002(qryp, pri_data); \
326 1.1 cliff found = true; \
327 1.1 cliff break; \
328 1.1 cliff } \
329 1.1 cliff default: \
330 1.1 cliff printf("%s: unsupported id_pri=%#x\n", \
331 1.1 cliff __func__, qryp->id_pri); \
332 1.1 cliff break; /* unknown command set */ \
333 1.1 cliff } \
334 1.1 cliff } while (0)
335 1.1 cliff
336 1.4 cliff #ifdef CFI_DEBUG_QRY
337 1.4 cliff # define CFI_DUMP_QRY(off, p, sz, stride) \
338 1.4 cliff do { \
339 1.4 cliff printf("%s: QRY data\n", __func__); \
340 1.4 cliff cfi_hexdump(off, p, sz, stride); \
341 1.4 cliff } while (0)
342 1.4 cliff #else
343 1.4 cliff # define CFI_DUMP_QRY(off, p, sz, stride)
344 1.4 cliff #endif
345 1.4 cliff
346 1.4 cliff #ifdef CFI_DEBUG_JEDEC
347 1.4 cliff # define CFI_DUMP_JEDEC(off, p, sz, stride) \
348 1.4 cliff do { \
349 1.4 cliff printf("%s: JEDEC data\n", __func__); \
350 1.4 cliff cfi_hexdump(off, p, sz, stride); \
351 1.4 cliff } while (0)
352 1.4 cliff #else
353 1.4 cliff # define CFI_DUMP_JEDEC(off, p, sz, stride)
354 1.4 cliff #endif
355 1.4 cliff
356 1.4 cliff
357 1.1 cliff /*
358 1.1 cliff * cfi_chip_query_opmode - determine operational mode based on QRY signature
359 1.1 cliff */
360 1.1 cliff static bool
361 1.1 cliff cfi_chip_query_opmode(struct cfi *cfi, uint8_t *data,
362 1.1 cliff const struct cfi_opmodes *tab, u_int nentries)
363 1.1 cliff {
364 1.1 cliff for (u_int i=0; i < nentries; i++) {
365 1.1 cliff if (memcmp(&data[tab[i].qsa], tab[i].sig, tab[i].len) == 0) {
366 1.1 cliff cfi->cfi_opmode = &tab[i];
367 1.1 cliff return true;
368 1.1 cliff }
369 1.1 cliff }
370 1.1 cliff return false;
371 1.1 cliff }
372 1.1 cliff
373 1.1 cliff static bool
374 1.1 cliff cfi_chip_query_1(struct cfi * const cfi)
375 1.1 cliff {
376 1.1 cliff uint8_t data[0x80];
377 1.1 cliff
378 1.1 cliff bus_space_read_region_1(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
379 1.1 cliff __arraycount(data));
380 1.1 cliff
381 1.4 cliff CFI_DUMP_QRY(0, data, sizeof(data), 1);
382 1.4 cliff
383 1.1 cliff bool found = cfi_chip_query_opmode(cfi, data, cfi_opmodes_1,
384 1.1 cliff __arraycount(cfi_opmodes_1));
385 1.1 cliff
386 1.1 cliff if (found) {
387 1.1 cliff CFI_QRY_UNPACK_COMMON(cfi, data, uint8_t, found);
388 1.1 cliff }
389 1.1 cliff
390 1.1 cliff return found;
391 1.1 cliff }
392 1.1 cliff
393 1.1 cliff static bool
394 1.1 cliff cfi_chip_query_2(struct cfi * const cfi)
395 1.1 cliff {
396 1.1 cliff uint16_t data[0x80];
397 1.1 cliff
398 1.1 cliff bus_space_read_region_2(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
399 1.1 cliff __arraycount(data));
400 1.1 cliff
401 1.4 cliff CFI_DUMP_QRY(0, data, sizeof(data), 2);
402 1.4 cliff
403 1.1 cliff bool found = cfi_chip_query_opmode(cfi, (uint8_t *)data,
404 1.1 cliff cfi_opmodes_2, __arraycount(cfi_opmodes_2));
405 1.1 cliff
406 1.1 cliff if (found) {
407 1.1 cliff CFI_QRY_UNPACK_COMMON(cfi, data, uint16_t, found);
408 1.1 cliff }
409 1.1 cliff
410 1.1 cliff return found;
411 1.1 cliff }
412 1.1 cliff
413 1.1 cliff static bool
414 1.1 cliff cfi_chip_query_4(struct cfi * const cfi)
415 1.1 cliff {
416 1.1 cliff uint32_t data[0x80];
417 1.1 cliff
418 1.1 cliff bus_space_read_region_4(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
419 1.1 cliff __arraycount(data));
420 1.1 cliff
421 1.4 cliff CFI_DUMP_QRY(0, data, sizeof(data), 4);
422 1.4 cliff
423 1.1 cliff bool found = cfi_chip_query_opmode(cfi, (uint8_t *)data,
424 1.1 cliff cfi_opmodes_4, __arraycount(cfi_opmodes_4));
425 1.1 cliff
426 1.1 cliff if (found) {
427 1.1 cliff CFI_QRY_UNPACK_COMMON(cfi, data, uint32_t, found);
428 1.1 cliff }
429 1.1 cliff
430 1.1 cliff return found;
431 1.1 cliff }
432 1.1 cliff
433 1.1 cliff static bool
434 1.1 cliff cfi_chip_query_8(struct cfi * const cfi)
435 1.1 cliff {
436 1.1 cliff #ifdef NOTYET
437 1.1 cliff uint64_t data[0x80];
438 1.1 cliff
439 1.1 cliff bus_space_read_region_8(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
440 1.1 cliff __arraycount(data));
441 1.1 cliff
442 1.4 cliff CFI_DUMP_QRY(0, data, sizeof(data), 8);
443 1.4 cliff
444 1.1 cliff bool found = cfi_chip_query_opmode(cfi, (uint8_t *)data,
445 1.1 cliff cfi_opmodes_8, __arraycount(cfi_opmodes_8));
446 1.1 cliff
447 1.1 cliff if (found) {
448 1.1 cliff CFI_QRY_UNPACK_COMMON(cfi, data, uint64_t, found);
449 1.1 cliff }
450 1.1 cliff
451 1.1 cliff return found;
452 1.1 cliff #else
453 1.1 cliff return false;
454 1.1 cliff #endif
455 1.1 cliff }
456 1.1 cliff
457 1.1 cliff /*
458 1.1 cliff * cfi_chip_query - detect a CFI chip
459 1.1 cliff *
460 1.1 cliff * fill in the struct cfi as we discover what's there
461 1.1 cliff */
462 1.1 cliff static bool
463 1.1 cliff cfi_chip_query(struct cfi * const cfi)
464 1.1 cliff {
465 1.1 cliff bool found = false;
466 1.1 cliff const bus_size_t cfi_query_offset[] = {
467 1.1 cliff CFI_QUERY_MODE_ADDRESS,
468 1.1 cliff CFI_QUERY_MODE_ALT_ADDRESS
469 1.1 cliff };
470 1.1 cliff
471 1.1 cliff KASSERT(cfi != NULL);
472 1.1 cliff KASSERT(cfi->cfi_bst != NULL);
473 1.1 cliff
474 1.1 cliff for (int j=0; !found && j < __arraycount(cfi_query_offset); j++) {
475 1.1 cliff
476 1.1 cliff cfi_reset_default(cfi);
477 1.1 cliff cfi_cmd(cfi, cfi_query_offset[j], CFI_QUERY_DATA);
478 1.1 cliff
479 1.1 cliff switch(cfi->cfi_portwidth) {
480 1.1 cliff case 0:
481 1.1 cliff found = cfi_chip_query_1(cfi);
482 1.1 cliff break;
483 1.1 cliff case 1:
484 1.1 cliff found = cfi_chip_query_2(cfi);
485 1.1 cliff break;
486 1.1 cliff case 2:
487 1.1 cliff found = cfi_chip_query_4(cfi);
488 1.1 cliff break;
489 1.1 cliff case 3:
490 1.1 cliff found = cfi_chip_query_8(cfi);
491 1.1 cliff break;
492 1.1 cliff default:
493 1.1 cliff panic("%s: bad portwidth %d\n",
494 1.1 cliff __func__, cfi->cfi_portwidth);
495 1.1 cliff }
496 1.1 cliff }
497 1.1 cliff
498 1.4 cliff if (found)
499 1.4 cliff cfi->cfi_emulated = false;
500 1.4 cliff
501 1.1 cliff return found;
502 1.1 cliff }
503 1.1 cliff
504 1.1 cliff /*
505 1.1 cliff * cfi_probe - search for a CFI NOR trying various port & chip widths
506 1.1 cliff *
507 1.4 cliff * - gather CFI QRY and PRI data
508 1.4 cliff * - gather JEDEC ID data
509 1.4 cliff * - if cfi_chip_query() fails, emulate CFI using table data if possible,
510 1.4 cliff * otherwise fail.
511 1.4 cliff *
512 1.1 cliff * NOTE:
513 1.1 cliff * striped NOR chips design not supported yet,
514 1.1 cliff * so force portwidth=chipwidth for now
515 1.1 cliff * eventually permute portwidth seperately
516 1.1 cliff */
517 1.1 cliff bool
518 1.1 cliff cfi_probe(struct cfi * const cfi)
519 1.1 cliff {
520 1.1 cliff bool found;
521 1.1 cliff
522 1.1 cliff KASSERT(cfi != NULL);
523 1.1 cliff
524 1.1 cliff for (u_int cw = 0; cw < 3; cw++) {
525 1.1 cliff cfi->cfi_portwidth = /* XXX */
526 1.1 cliff cfi->cfi_chipwidth = cw;
527 1.1 cliff found = cfi_chip_query(cfi);
528 1.4 cliff cfi_jedec_id(cfi);
529 1.4 cliff if (! found)
530 1.4 cliff found = cfi_emulate(cfi);
531 1.1 cliff if (found)
532 1.4 cliff break;
533 1.1 cliff }
534 1.4 cliff
535 1.1 cliff cfi_reset_default(cfi); /* exit QRY mode */
536 1.1 cliff return found;
537 1.1 cliff }
538 1.1 cliff
539 1.1 cliff bool
540 1.1 cliff cfi_identify(struct cfi * const cfi)
541 1.1 cliff {
542 1.1 cliff const bus_space_tag_t bst = cfi->cfi_bst;
543 1.1 cliff const bus_space_handle_t bsh = cfi->cfi_bsh;
544 1.4 cliff bool found;
545 1.1 cliff
546 1.1 cliff KASSERT(cfi != NULL);
547 1.1 cliff KASSERT(bst != NULL);
548 1.1 cliff
549 1.1 cliff memset(cfi, 0, sizeof(struct cfi)); /* XXX clean slate */
550 1.1 cliff cfi->cfi_bst = bst; /* restore bus space */
551 1.1 cliff cfi->cfi_bsh = bsh; /* " " " */
552 1.1 cliff
553 1.4 cliff found = cfi_probe(cfi);
554 1.1 cliff
555 1.1 cliff cfi_reset_default(cfi); /* exit QRY mode */
556 1.1 cliff
557 1.1 cliff return found;
558 1.1 cliff }
559 1.1 cliff
560 1.1 cliff static int
561 1.1 cliff cfi_scan_media(device_t self, struct nor_chip *chip)
562 1.1 cliff {
563 1.1 cliff struct nor_softc *sc = device_private(self);
564 1.1 cliff KASSERT(sc != NULL);
565 1.1 cliff KASSERT(sc->sc_nor_if != NULL);
566 1.1 cliff struct cfi * const cfi = (struct cfi * const)sc->sc_nor_if->private;
567 1.1 cliff KASSERT(cfi != NULL);
568 1.1 cliff
569 1.1 cliff sc->sc_nor_if->access_width = cfi->cfi_portwidth;
570 1.1 cliff
571 1.1 cliff chip->nc_manf_id = cfi->cfi_id_data.id_mid;
572 1.1 cliff chip->nc_dev_id = cfi->cfi_id_data.id_did[0]; /* XXX 3 words */
573 1.1 cliff chip->nc_size = 1 << cfi->cfi_qry_data.device_size;
574 1.1 cliff
575 1.1 cliff /* size of line for Read Buf command */
576 1.1 cliff chip->nc_line_size = 1 << cfi->cfi_qry_data.pri.cmd_0002.page_size;
577 1.1 cliff
578 1.1 cliff /*
579 1.1 cliff * size of erase block
580 1.1 cliff * XXX depends on erase region
581 1.1 cliff */
582 1.1 cliff chip->nc_num_luns = 1;
583 1.1 cliff chip->nc_lun_blocks = cfi->cfi_qry_data.erase_blk_info[0].y + 1;
584 1.1 cliff chip->nc_block_size = cfi->cfi_qry_data.erase_blk_info[0].z * 256;
585 1.1 cliff
586 1.1 cliff switch (cfi->cfi_qry_data.id_pri) {
587 1.1 cliff case 0x0002:
588 1.1 cliff cfi_0002_init(sc, cfi, chip);
589 1.1 cliff break;
590 1.1 cliff default:
591 1.4 cliff aprint_error_dev(self, "unsupported CFI cmdset %#04x\n",
592 1.4 cliff cfi->cfi_qry_data.id_pri);
593 1.1 cliff return -1;
594 1.1 cliff }
595 1.1 cliff
596 1.1 cliff return 0;
597 1.1 cliff }
598 1.1 cliff
599 1.1 cliff void
600 1.1 cliff cfi_init(device_t self)
601 1.1 cliff {
602 1.1 cliff /* nothing */
603 1.1 cliff }
604 1.1 cliff
605 1.1 cliff static void
606 1.1 cliff cfi_select(device_t self, bool select)
607 1.1 cliff {
608 1.1 cliff /* nothing */
609 1.1 cliff }
610 1.1 cliff
611 1.1 cliff static void
612 1.1 cliff cfi_read_1(device_t self, flash_off_t offset, uint8_t *datap)
613 1.1 cliff {
614 1.1 cliff }
615 1.1 cliff
616 1.1 cliff static void
617 1.1 cliff cfi_read_2(device_t self, flash_off_t offset, uint16_t *datap)
618 1.1 cliff {
619 1.1 cliff }
620 1.1 cliff
621 1.1 cliff static void
622 1.1 cliff cfi_read_4(device_t self, flash_off_t offset, uint32_t *datap)
623 1.1 cliff {
624 1.1 cliff }
625 1.1 cliff
626 1.1 cliff static void
627 1.1 cliff cfi_read_buf_1(device_t self, flash_off_t offset, uint8_t *datap, size_t size)
628 1.1 cliff {
629 1.1 cliff }
630 1.1 cliff
631 1.1 cliff static void
632 1.1 cliff cfi_read_buf_2(device_t self, flash_off_t offset, uint16_t *datap, size_t size)
633 1.1 cliff {
634 1.1 cliff }
635 1.1 cliff
636 1.1 cliff static void
637 1.1 cliff cfi_read_buf_4(device_t self, flash_off_t offset, uint32_t *datap, size_t size)
638 1.1 cliff {
639 1.1 cliff }
640 1.1 cliff
641 1.1 cliff static void
642 1.1 cliff cfi_write_1(device_t self, flash_off_t offset, uint8_t data)
643 1.1 cliff {
644 1.1 cliff }
645 1.1 cliff
646 1.1 cliff static void
647 1.1 cliff cfi_write_2(device_t self, flash_off_t offset, uint16_t data)
648 1.1 cliff {
649 1.1 cliff }
650 1.1 cliff
651 1.1 cliff static void
652 1.1 cliff cfi_write_4(device_t self, flash_off_t offset, uint32_t data)
653 1.1 cliff {
654 1.1 cliff }
655 1.1 cliff
656 1.1 cliff static void
657 1.1 cliff cfi_write_buf_1(device_t self, flash_off_t offset, const uint8_t *datap,
658 1.1 cliff size_t size)
659 1.1 cliff {
660 1.1 cliff }
661 1.1 cliff
662 1.1 cliff static void
663 1.1 cliff cfi_write_buf_2(device_t self, flash_off_t offset, const uint16_t *datap,
664 1.1 cliff size_t size)
665 1.1 cliff {
666 1.1 cliff }
667 1.1 cliff
668 1.1 cliff static void
669 1.1 cliff cfi_write_buf_4(device_t self, flash_off_t offset, const uint32_t *datap,
670 1.1 cliff size_t size)
671 1.1 cliff {
672 1.1 cliff }
673 1.1 cliff
674 1.1 cliff void
675 1.1 cliff cfi_cmd(struct cfi * const cfi, bus_size_t off, uint32_t val)
676 1.1 cliff {
677 1.1 cliff const bus_space_tag_t bst = cfi->cfi_bst;
678 1.1 cliff bus_space_handle_t bsh = cfi->cfi_bsh;
679 1.1 cliff
680 1.1 cliff off <<= cfi->cfi_portwidth;
681 1.1 cliff
682 1.1 cliff DPRINTF(("%s: %p %x %x %x\n", __func__, bst, bsh, off, val));
683 1.1 cliff
684 1.1 cliff switch(cfi->cfi_portwidth) {
685 1.1 cliff case 0:
686 1.1 cliff bus_space_write_1(bst, bsh, off, (uint8_t)val);
687 1.1 cliff break;
688 1.1 cliff case 1:
689 1.1 cliff bus_space_write_2(bst, bsh, off, val);
690 1.1 cliff break;
691 1.1 cliff case 2:
692 1.1 cliff bus_space_write_4(bst, bsh, off, (uint32_t)val);
693 1.1 cliff break;
694 1.1 cliff #ifdef NOTYET
695 1.1 cliff case 3:
696 1.1 cliff bus_space_write_4(bst, bsh, off, (uint64_t)val);
697 1.1 cliff break;
698 1.1 cliff #endif
699 1.1 cliff default:
700 1.1 cliff panic("%s: bad portwidth %d bytes\n",
701 1.1 cliff __func__, 1 << cfi->cfi_portwidth);
702 1.1 cliff }
703 1.1 cliff }
704 1.1 cliff
705 1.1 cliff /*
706 1.1 cliff * cfi_reset_default - when we don't know which command will work, use both
707 1.1 cliff */
708 1.1 cliff void
709 1.1 cliff cfi_reset_default(struct cfi * const cfi)
710 1.1 cliff {
711 1.1 cliff cfi_cmd(cfi, CFI_ADDRESS_ANY, CFI_RESET_DATA);
712 1.1 cliff cfi_cmd(cfi, CFI_ADDRESS_ANY, CFI_ALT_RESET_DATA);
713 1.1 cliff }
714 1.1 cliff
715 1.1 cliff /*
716 1.1 cliff * cfi_reset_std - use standard reset command
717 1.1 cliff */
718 1.1 cliff void
719 1.1 cliff cfi_reset_std(struct cfi * const cfi)
720 1.1 cliff {
721 1.1 cliff cfi_cmd(cfi, CFI_ADDRESS_ANY, CFI_RESET_DATA);
722 1.1 cliff }
723 1.1 cliff
724 1.1 cliff /*
725 1.1 cliff * cfi_reset_alt - use "alternate" reset command
726 1.1 cliff */
727 1.1 cliff void
728 1.1 cliff cfi_reset_alt(struct cfi * const cfi)
729 1.1 cliff {
730 1.1 cliff cfi_cmd(cfi, CFI_ADDRESS_ANY, CFI_ALT_RESET_DATA);
731 1.1 cliff }
732 1.1 cliff
733 1.1 cliff static void
734 1.4 cliff cfi_jedec_id_1(struct cfi * const cfi)
735 1.4 cliff {
736 1.4 cliff struct cfi_jedec_id_data *idp = &cfi->cfi_id_data;
737 1.4 cliff uint8_t data[0x10];
738 1.4 cliff
739 1.4 cliff bus_space_read_region_1(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
740 1.4 cliff __arraycount(data));
741 1.4 cliff
742 1.4 cliff CFI_DUMP_JEDEC(0, data, sizeof(data), 1);
743 1.4 cliff
744 1.4 cliff idp->id_mid = (uint16_t)data[0];
745 1.4 cliff idp->id_did[0] = (uint16_t)data[1];
746 1.4 cliff idp->id_did[1] = (uint16_t)data[0xe];
747 1.4 cliff idp->id_did[2] = (uint16_t)data[0xf];
748 1.4 cliff idp->id_prot_state = (uint16_t)data[2];
749 1.4 cliff idp->id_indicators = (uint16_t)data[3];
750 1.4 cliff
751 1.4 cliff /* software bits, upper and lower */
752 1.4 cliff idp->id_swb_lo = data[0xc];
753 1.4 cliff idp->id_swb_hi = data[0xd];
754 1.4 cliff
755 1.4 cliff }
756 1.4 cliff
757 1.4 cliff static void
758 1.1 cliff cfi_jedec_id_2(struct cfi * const cfi)
759 1.1 cliff {
760 1.1 cliff struct cfi_jedec_id_data *idp = &cfi->cfi_id_data;
761 1.1 cliff uint16_t data[0x10];
762 1.1 cliff
763 1.1 cliff bus_space_read_region_2(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
764 1.1 cliff __arraycount(data));
765 1.1 cliff
766 1.4 cliff CFI_DUMP_JEDEC(0, data, sizeof(data), 1);
767 1.4 cliff
768 1.1 cliff idp->id_mid = data[0];
769 1.1 cliff idp->id_did[0] = data[1];
770 1.1 cliff idp->id_did[1] = data[0xe];
771 1.1 cliff idp->id_did[2] = data[0xf];
772 1.1 cliff idp->id_prot_state = data[2];
773 1.1 cliff idp->id_indicators = data[3];
774 1.1 cliff
775 1.1 cliff /* software bits, upper and lower
776 1.1 cliff * - undefined on S29GL-P
777 1.1 cliff * - defined on S29GL-S
778 1.1 cliff */
779 1.1 cliff idp->id_swb_lo = data[0xc];
780 1.1 cliff idp->id_swb_hi = data[0xd];
781 1.4 cliff
782 1.4 cliff }
783 1.4 cliff
784 1.4 cliff static void
785 1.4 cliff cfi_jedec_id_4(struct cfi * const cfi)
786 1.4 cliff {
787 1.4 cliff struct cfi_jedec_id_data *idp = &cfi->cfi_id_data;
788 1.4 cliff uint32_t data[0x10];
789 1.4 cliff
790 1.4 cliff bus_space_read_region_4(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
791 1.4 cliff __arraycount(data));
792 1.4 cliff
793 1.4 cliff CFI_DUMP_JEDEC(0, data, sizeof(data), 1);
794 1.4 cliff
795 1.4 cliff idp->id_mid = data[0] & 0xffff;
796 1.4 cliff idp->id_did[0] = data[1] & 0xffff;
797 1.4 cliff idp->id_did[1] = data[0xe] & 0xffff;
798 1.4 cliff idp->id_did[2] = data[0xf] & 0xffff;
799 1.4 cliff idp->id_prot_state = data[2] & 0xffff;
800 1.4 cliff idp->id_indicators = data[3] & 0xffff;
801 1.4 cliff
802 1.4 cliff /* software bits, upper and lower
803 1.4 cliff * - undefined on S29GL-P
804 1.4 cliff * - defined on S29GL-S
805 1.4 cliff */
806 1.4 cliff idp->id_swb_lo = data[0xc] & 0xffff;
807 1.4 cliff idp->id_swb_hi = data[0xd] & 0xffff;
808 1.4 cliff
809 1.1 cliff }
810 1.1 cliff
811 1.1 cliff /*
812 1.1 cliff * cfi_jedec_id - get JEDEC ID info
813 1.1 cliff */
814 1.1 cliff static bool
815 1.1 cliff cfi_jedec_id(struct cfi * const cfi)
816 1.1 cliff {
817 1.4 cliff
818 1.1 cliff DPRINTF(("%s\n", __func__));
819 1.1 cliff
820 1.1 cliff cfi_cmd(cfi, 0x555, 0xaa);
821 1.1 cliff cfi_cmd(cfi, 0x2aa, 0x55);
822 1.1 cliff cfi_cmd(cfi, 0x555, 0x90);
823 1.1 cliff
824 1.1 cliff switch(cfi->cfi_portwidth) {
825 1.4 cliff case 0:
826 1.4 cliff cfi_jedec_id_1(cfi);
827 1.4 cliff break;
828 1.1 cliff case 1:
829 1.1 cliff cfi_jedec_id_2(cfi);
830 1.1 cliff break;
831 1.1 cliff case 2:
832 1.1 cliff cfi_jedec_id_4(cfi);
833 1.1 cliff break;
834 1.4 cliff #ifdef NOTYET
835 1.1 cliff case 3:
836 1.1 cliff cfi_jedec_id_8(cfi);
837 1.1 cliff break;
838 1.1 cliff #endif
839 1.1 cliff default:
840 1.1 cliff panic("%s: bad portwidth %d bytes\n",
841 1.1 cliff __func__, 1 << cfi->cfi_portwidth);
842 1.1 cliff }
843 1.1 cliff
844 1.1 cliff return true;
845 1.1 cliff }
846 1.1 cliff
847 1.4 cliff static bool
848 1.4 cliff cfi_emulate(struct cfi * const cfi)
849 1.4 cliff {
850 1.4 cliff bool found = false;
851 1.4 cliff const struct cfi_jedec_tab *jt = cfi_jedec_search(cfi);
852 1.4 cliff if (jt != NULL) {
853 1.4 cliff found = true;
854 1.4 cliff cfi->cfi_emulated = true;
855 1.4 cliff cfi_jedec_fill(cfi, jt);
856 1.4 cliff }
857 1.4 cliff return found;
858 1.4 cliff }
859 1.4 cliff
860 1.4 cliff /*
861 1.4 cliff * cfi_jedec_search - search cfi_jedec_tab[] for entry matching given JEDEC IDs
862 1.4 cliff */
863 1.4 cliff static const struct cfi_jedec_tab *
864 1.4 cliff cfi_jedec_search(struct cfi *cfi)
865 1.4 cliff {
866 1.4 cliff struct cfi_jedec_id_data *idp = &cfi->cfi_id_data;
867 1.4 cliff
868 1.4 cliff for (u_int i=0; i < __arraycount(cfi_jedec_tab); i++) {
869 1.4 cliff const struct cfi_jedec_tab *jt = &cfi_jedec_tab[i];
870 1.4 cliff if ((jt->jt_mid == idp->id_mid) &&
871 1.4 cliff (jt->jt_did == idp->id_did[0])) {
872 1.4 cliff return jt;
873 1.4 cliff }
874 1.4 cliff }
875 1.4 cliff return NULL;
876 1.4 cliff }
877 1.4 cliff
878 1.4 cliff /*
879 1.4 cliff * cfi_jedec_fill - fill in cfi with info from table entry
880 1.4 cliff */
881 1.4 cliff static void
882 1.4 cliff cfi_jedec_fill(struct cfi *cfi, const struct cfi_jedec_tab *jt)
883 1.4 cliff {
884 1.5 cliff
885 1.4 cliff cfi->cfi_name = jt->jt_name;
886 1.4 cliff cfi->cfi_opmode = jt->jt_opmode;
887 1.5 cliff
888 1.5 cliff struct cfi_query_data *qryp = &cfi->cfi_qry_data;
889 1.5 cliff memset(&qryp, 0, sizeof(*qryp));
890 1.5 cliff qryp->id_pri = jt->jt_id_pri;
891 1.5 cliff qryp->id_alt = jt->jt_id_alt;
892 1.5 cliff qryp->interface_code_desc = jt->jt_interface_code_desc;
893 1.5 cliff qryp->write_word_time_typ = jt->jt_write_word_time_typ;
894 1.5 cliff qryp->write_nbyte_time_typ = jt->jt_write_nbyte_time_typ;
895 1.5 cliff qryp->erase_blk_time_typ = jt->jt_erase_blk_time_typ;
896 1.5 cliff qryp->erase_chip_time_typ = jt->jt_erase_chip_time_typ;
897 1.5 cliff qryp->write_word_time_max = jt->jt_write_word_time_max;
898 1.5 cliff qryp->write_nbyte_time_max = jt->jt_write_nbyte_time_max;
899 1.5 cliff qryp->erase_blk_time_max = jt->jt_erase_blk_time_max;
900 1.5 cliff qryp->erase_chip_time_max = jt->jt_erase_chip_time_max;
901 1.5 cliff qryp->device_size = jt->jt_device_size;
902 1.5 cliff qryp->interface_code_desc = jt->jt_interface_code_desc;
903 1.5 cliff qryp->write_nbyte_size_max = jt->jt_write_nbyte_size_max;
904 1.5 cliff qryp->erase_blk_regions = jt->jt_erase_blk_regions;
905 1.4 cliff for (u_int i=0; i < 4; i++)
906 1.5 cliff qryp->erase_blk_info[i] = jt->jt_erase_blk_info[i];
907 1.5 cliff
908 1.4 cliff }
909 1.4 cliff
910 1.1 cliff void
911 1.1 cliff cfi_print(device_t self, struct cfi * const cfi)
912 1.1 cliff {
913 1.1 cliff char pbuf[sizeof("XXXX MB")];
914 1.1 cliff struct cfi_query_data * const qryp = &cfi->cfi_qry_data;
915 1.1 cliff
916 1.1 cliff format_bytes(pbuf, sizeof(pbuf), 1 << qryp->device_size);
917 1.4 cliff if (cfi->cfi_emulated) {
918 1.4 cliff aprint_normal_dev(self, "%s NOR flash %s %s\n",
919 1.4 cliff cfi->cfi_name, pbuf,
920 1.4 cliff cfi_interface_desc_str(qryp->interface_code_desc));
921 1.4 cliff } else {
922 1.4 cliff aprint_normal_dev(self, "CFI NOR flash %s %s\n", pbuf,
923 1.4 cliff cfi_interface_desc_str(qryp->interface_code_desc));
924 1.4 cliff }
925 1.1 cliff #ifdef NOR_VERBOSE
926 1.1 cliff aprint_normal_dev(self, "manufacturer id %#x, device id %#x %#x %#x\n",
927 1.1 cliff cfi->cfi_id_data.id_mid,
928 1.1 cliff cfi->cfi_id_data.id_did[0],
929 1.1 cliff cfi->cfi_id_data.id_did[1],
930 1.1 cliff cfi->cfi_id_data.id_did[2]);
931 1.1 cliff aprint_normal_dev(self, "%s\n", cfi->cfi_opmode->str);
932 1.1 cliff aprint_normal_dev(self, "sw bits lo=%#x hi=%#x\n",
933 1.1 cliff cfi->cfi_id_data.id_swb_lo,
934 1.1 cliff cfi->cfi_id_data.id_swb_hi);
935 1.1 cliff aprint_normal_dev(self, "max multibyte write size %d\n",
936 1.1 cliff 1 << qryp->write_nbyte_size_max);
937 1.1 cliff aprint_normal_dev(self, "%d Erase Block Region(s)\n",
938 1.1 cliff qryp->erase_blk_regions);
939 1.1 cliff for (u_int r=0; r < qryp->erase_blk_regions; r++) {
940 1.1 cliff size_t sz = qryp->erase_blk_info[r].z * 256;
941 1.1 cliff format_bytes(pbuf, sizeof(pbuf), sz);
942 1.1 cliff aprint_normal(" %d: %d blocks, size %s\n", r,
943 1.1 cliff qryp->erase_blk_info[r].y + 1, pbuf);
944 1.1 cliff }
945 1.1 cliff #endif
946 1.1 cliff
947 1.1 cliff switch (cfi->cfi_qry_data.id_pri) {
948 1.1 cliff case 0x0002:
949 1.1 cliff cfi_0002_print(self, cfi);
950 1.1 cliff break;
951 1.1 cliff }
952 1.1 cliff }
953 1.4 cliff
954 1.4 cliff #if defined(CFI_DEBUG_JEDEC) || defined(CFI_DEBUG_QRY)
955 1.4 cliff void
956 1.4 cliff cfi_hexdump(flash_off_t offset, void * const v, u_int count, u_int stride)
957 1.4 cliff {
958 1.4 cliff uint8_t * const data = v;
959 1.4 cliff for(int n=0; n < count; n+=16) {
960 1.4 cliff int i;
961 1.4 cliff printf("%08llx: ", (offset + n) / stride);
962 1.4 cliff for(i=n; i < n+16; i++)
963 1.4 cliff printf("%02x ", data[i]);
964 1.4 cliff printf("\t");
965 1.4 cliff for(i=n; i < n+16; i++) {
966 1.4 cliff u_int c = (int)data[i];
967 1.4 cliff if (c >= 0x20 && c < 0x7f)
968 1.4 cliff printf("%c", c);
969 1.4 cliff else
970 1.4 cliff printf("%c", '.');
971 1.4 cliff }
972 1.4 cliff printf("\n");
973 1.4 cliff }
974 1.4 cliff }
975 1.4 cliff #endif
976