Home | History | Annotate | Line # | Download | only in nor
cfi.c revision 1.6
      1  1.6   cliff /*	$NetBSD: cfi.c,v 1.6 2011/08/02 03:37:25 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.6   cliff __KERNEL_RCSID(0, "$NetBSD: cfi.c,v 1.6 2011/08/02 03:37:25 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.6   cliff /* construct 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.6   cliff /* construct 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.6   cliff 	(qryp)->id_pri = cfi_unpack_2(data[0x13], data[0x14]);		\
    242  1.6   cliff 	(qryp)->addr_pri = cfi_unpack_2(data[0x15], data[0x16]);	\
    243  1.6   cliff 	(qryp)->id_alt = cfi_unpack_2(data[0x17], data[0x18]);		\
    244  1.6   cliff 	(qryp)->addr_alt = cfi_unpack_2(data[0x19], data[0x1a]);	\
    245  1.1   cliff 	(qryp)->vcc_min = cfi_unpack_1(data[0x1b]);			\
    246  1.1   cliff 	(qryp)->vcc_max = cfi_unpack_1(data[0x1c]);			\
    247  1.1   cliff 	(qryp)->vpp_min = cfi_unpack_1(data[0x1d]);			\
    248  1.1   cliff 	(qryp)->vpp_max = cfi_unpack_1(data[0x1e]);			\
    249  1.1   cliff 	(qryp)->write_word_time_typ = cfi_unpack_1(data[0x1f]);		\
    250  1.1   cliff 	(qryp)->write_nbyte_time_typ = cfi_unpack_1(data[0x20]);	\
    251  1.1   cliff 	(qryp)->erase_blk_time_typ = cfi_unpack_1(data[0x21]);		\
    252  1.4   cliff 	(qryp)->erase_chip_time_typ = cfi_unpack_1(data[0x22]);		\
    253  1.1   cliff 	(qryp)->write_word_time_max = cfi_unpack_1(data[0x23]);		\
    254  1.1   cliff 	(qryp)->write_nbyte_time_max = cfi_unpack_1(data[0x24]);	\
    255  1.1   cliff 	(qryp)->erase_blk_time_max = cfi_unpack_1(data[0x25]);		\
    256  1.4   cliff 	(qryp)->erase_chip_time_max = cfi_unpack_1(data[0x26]);		\
    257  1.1   cliff 	(qryp)->device_size = cfi_unpack_1(data[0x27]);			\
    258  1.1   cliff 	(qryp)->interface_code_desc =					\
    259  1.6   cliff 		cfi_unpack_2(data[0x28], data[0x29]);			\
    260  1.1   cliff 	(qryp)->write_nbyte_size_max = 					\
    261  1.6   cliff 		cfi_unpack_2(data[0x2a], data[0x2b]);			\
    262  1.1   cliff 	(qryp)->erase_blk_regions = cfi_unpack_1(data[0x2c]);		\
    263  1.1   cliff 	u_int _i = 0x2d;						\
    264  1.1   cliff 	const u_int _n = (qryp)->erase_blk_regions;			\
    265  1.1   cliff 	KASSERT(_n <= 4);						\
    266  1.1   cliff 	for (u_int _r = 0; _r < _n; _r++, _i+=4) {			\
    267  1.1   cliff 		(qryp)->erase_blk_info[_r].y =				\
    268  1.6   cliff 			cfi_unpack_2(data[_i+0], data[_i+1]);		\
    269  1.1   cliff 		(qryp)->erase_blk_info[_r].z =				\
    270  1.6   cliff 			cfi_unpack_2(data[_i+2], data[_i+3]);		\
    271  1.1   cliff 	}								\
    272  1.1   cliff     } while (0)
    273  1.1   cliff 
    274  1.1   cliff #define cfi_unpack_pri_0002(qryp, data)					\
    275  1.1   cliff     do {								\
    276  1.1   cliff 	(qryp)->pri.cmd_0002.pri[0] = cfi_unpack_1(data[0x00]);		\
    277  1.1   cliff 	(qryp)->pri.cmd_0002.pri[1] = cfi_unpack_1(data[0x01]);		\
    278  1.1   cliff 	(qryp)->pri.cmd_0002.pri[2] = cfi_unpack_1(data[0x02]);		\
    279  1.1   cliff 	(qryp)->pri.cmd_0002.version_maj = cfi_unpack_1(data[0x03]);	\
    280  1.1   cliff 	(qryp)->pri.cmd_0002.version_min = cfi_unpack_1(data[0x04]);	\
    281  1.1   cliff 	(qryp)->pri.cmd_0002.asupt = cfi_unpack_1(data[0x05]);		\
    282  1.1   cliff 	(qryp)->pri.cmd_0002.erase_susp = cfi_unpack_1(data[0x06]);	\
    283  1.1   cliff 	(qryp)->pri.cmd_0002.sector_prot = cfi_unpack_1(data[0x07]);	\
    284  1.1   cliff 	(qryp)->pri.cmd_0002.tmp_sector_unprot =			\
    285  1.1   cliff 		cfi_unpack_1(data[0x08]);				\
    286  1.1   cliff 	(qryp)->pri.cmd_0002.sector_prot_scheme =			\
    287  1.1   cliff 		cfi_unpack_1(data[0x09]);				\
    288  1.1   cliff 	(qryp)->pri.cmd_0002.simul_op = cfi_unpack_1(data[0x0a]);	\
    289  1.1   cliff 	(qryp)->pri.cmd_0002.burst_mode_type = cfi_unpack_1(data[0x0b]);\
    290  1.1   cliff 	(qryp)->pri.cmd_0002.page_mode_type = cfi_unpack_1(data[0x0c]);	\
    291  1.1   cliff 	(qryp)->pri.cmd_0002.acc_min = cfi_unpack_1(data[0x0d]);	\
    292  1.1   cliff 	(qryp)->pri.cmd_0002.acc_max = cfi_unpack_1(data[0x0e]);	\
    293  1.1   cliff 	(qryp)->pri.cmd_0002.wp_prot = cfi_unpack_1(data[0x0f]);	\
    294  1.1   cliff 	/* XXX 1.3 stops here */					\
    295  1.1   cliff 	(qryp)->pri.cmd_0002.prog_susp = cfi_unpack_1(data[0x10]);	\
    296  1.1   cliff 	(qryp)->pri.cmd_0002.unlock_bypass = cfi_unpack_1(data[0x11]);	\
    297  1.1   cliff 	(qryp)->pri.cmd_0002.sss_size = cfi_unpack_1(data[0x12]);	\
    298  1.1   cliff 	(qryp)->pri.cmd_0002.soft_feat = cfi_unpack_1(data[0x13]);	\
    299  1.1   cliff 	(qryp)->pri.cmd_0002.page_size = cfi_unpack_1(data[0x14]);	\
    300  1.1   cliff 	(qryp)->pri.cmd_0002.erase_susp_time_max =			\
    301  1.1   cliff 		cfi_unpack_1(data[0x15]);				\
    302  1.1   cliff 	(qryp)->pri.cmd_0002.prog_susp_time_max =			\
    303  1.1   cliff 		cfi_unpack_1(data[0x16]);				\
    304  1.1   cliff 	(qryp)->pri.cmd_0002.embhwrst_time_max =			\
    305  1.1   cliff 		cfi_unpack_1(data[0x38]);				\
    306  1.1   cliff 	(qryp)->pri.cmd_0002.hwrst_time_max =				\
    307  1.1   cliff 		cfi_unpack_1(data[0x39]);				\
    308  1.1   cliff     } while (0)
    309  1.1   cliff 
    310  1.1   cliff #define CFI_QRY_UNPACK_COMMON(cfi, data, type, found)			\
    311  1.1   cliff     do {								\
    312  1.1   cliff 	struct cfi_query_data * const qryp = &cfi->cfi_qry_data;	\
    313  1.1   cliff 									\
    314  1.1   cliff 	memset(qryp, 0, sizeof(*qryp));					\
    315  1.1   cliff 	cfi_unpack_qry(qryp, data);					\
    316  1.1   cliff 									\
    317  1.1   cliff 	switch (qryp->id_pri) {						\
    318  1.1   cliff 	case 0x0002:							\
    319  1.1   cliff 		if ((cfi_unpack_1(data[qryp->addr_pri + 0]) == 'P') &&	\
    320  1.1   cliff 		    (cfi_unpack_1(data[qryp->addr_pri + 1]) == 'R') &&	\
    321  1.1   cliff 		    (cfi_unpack_1(data[qryp->addr_pri + 2]) == 'I')) {	\
    322  1.1   cliff 			type *pri_data = &data[qryp->addr_pri];		\
    323  1.1   cliff 			cfi_unpack_pri_0002(qryp, pri_data);		\
    324  1.1   cliff 			found = true;					\
    325  1.1   cliff 			break;						\
    326  1.1   cliff 		}							\
    327  1.1   cliff 	default:							\
    328  1.1   cliff 		printf("%s: unsupported id_pri=%#x\n",			\
    329  1.1   cliff 			__func__, qryp->id_pri);			\
    330  1.1   cliff 		break;	/* unknown command set */			\
    331  1.1   cliff 	}								\
    332  1.1   cliff     } while (0)
    333  1.1   cliff 
    334  1.4   cliff #ifdef CFI_DEBUG_QRY
    335  1.4   cliff # define CFI_DUMP_QRY(off, p, sz, stride)				\
    336  1.4   cliff     do {								\
    337  1.4   cliff 	printf("%s: QRY data\n", __func__);				\
    338  1.4   cliff 	cfi_hexdump(off, p, sz, stride);				\
    339  1.4   cliff     } while (0)
    340  1.4   cliff #else
    341  1.4   cliff # define CFI_DUMP_QRY(off, p, sz, stride)
    342  1.4   cliff #endif
    343  1.4   cliff 
    344  1.4   cliff #ifdef CFI_DEBUG_JEDEC
    345  1.4   cliff # define CFI_DUMP_JEDEC(off, p, sz, stride)				\
    346  1.4   cliff     do {								\
    347  1.4   cliff 	printf("%s: JEDEC data\n", __func__);				\
    348  1.4   cliff 	cfi_hexdump(off, p, sz, stride);				\
    349  1.4   cliff     } while (0)
    350  1.4   cliff #else
    351  1.4   cliff # define CFI_DUMP_JEDEC(off, p, sz, stride)
    352  1.4   cliff #endif
    353  1.4   cliff 
    354  1.4   cliff 
    355  1.1   cliff /*
    356  1.1   cliff  * cfi_chip_query_opmode - determine operational mode based on QRY signature
    357  1.1   cliff  */
    358  1.1   cliff static bool
    359  1.1   cliff cfi_chip_query_opmode(struct cfi *cfi, uint8_t *data,
    360  1.1   cliff     const struct cfi_opmodes *tab, u_int nentries)
    361  1.1   cliff {
    362  1.1   cliff 	for (u_int i=0; i < nentries; i++) {
    363  1.1   cliff 		if (memcmp(&data[tab[i].qsa], tab[i].sig, tab[i].len) == 0) {
    364  1.1   cliff 			cfi->cfi_opmode = &tab[i];
    365  1.1   cliff 			return true;
    366  1.1   cliff 		}
    367  1.1   cliff 	}
    368  1.1   cliff 	return false;
    369  1.1   cliff }
    370  1.1   cliff 
    371  1.1   cliff static bool
    372  1.1   cliff cfi_chip_query_1(struct cfi * const cfi)
    373  1.1   cliff {
    374  1.1   cliff 	uint8_t data[0x80];
    375  1.1   cliff 
    376  1.1   cliff 	bus_space_read_region_1(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
    377  1.1   cliff 		__arraycount(data));
    378  1.1   cliff 
    379  1.4   cliff 	CFI_DUMP_QRY(0, data, sizeof(data), 1);
    380  1.4   cliff 
    381  1.1   cliff 	bool found = cfi_chip_query_opmode(cfi, data, cfi_opmodes_1,
    382  1.1   cliff 		__arraycount(cfi_opmodes_1));
    383  1.1   cliff 
    384  1.1   cliff 	if (found) {
    385  1.1   cliff 		CFI_QRY_UNPACK_COMMON(cfi, data, uint8_t, found);
    386  1.1   cliff 	}
    387  1.1   cliff 
    388  1.1   cliff 	return found;
    389  1.1   cliff }
    390  1.1   cliff 
    391  1.1   cliff static bool
    392  1.1   cliff cfi_chip_query_2(struct cfi * const cfi)
    393  1.1   cliff {
    394  1.1   cliff 	uint16_t data[0x80];
    395  1.1   cliff 
    396  1.1   cliff 	bus_space_read_region_2(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
    397  1.1   cliff 		__arraycount(data));
    398  1.1   cliff 
    399  1.4   cliff 	CFI_DUMP_QRY(0, data, sizeof(data), 2);
    400  1.4   cliff 
    401  1.1   cliff 	bool found = cfi_chip_query_opmode(cfi, (uint8_t *)data,
    402  1.1   cliff 		cfi_opmodes_2, __arraycount(cfi_opmodes_2));
    403  1.1   cliff 
    404  1.1   cliff 	if (found) {
    405  1.1   cliff 		CFI_QRY_UNPACK_COMMON(cfi, data, uint16_t, found);
    406  1.1   cliff 	}
    407  1.1   cliff 
    408  1.1   cliff 	return found;
    409  1.1   cliff }
    410  1.1   cliff 
    411  1.1   cliff static bool
    412  1.1   cliff cfi_chip_query_4(struct cfi * const cfi)
    413  1.1   cliff {
    414  1.1   cliff 	uint32_t data[0x80];
    415  1.1   cliff 
    416  1.1   cliff 	bus_space_read_region_4(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
    417  1.1   cliff 		__arraycount(data));
    418  1.1   cliff 
    419  1.4   cliff 	CFI_DUMP_QRY(0, data, sizeof(data), 4);
    420  1.4   cliff 
    421  1.1   cliff 	bool found = cfi_chip_query_opmode(cfi, (uint8_t *)data,
    422  1.1   cliff 		cfi_opmodes_4, __arraycount(cfi_opmodes_4));
    423  1.1   cliff 
    424  1.1   cliff 	if (found) {
    425  1.1   cliff 		CFI_QRY_UNPACK_COMMON(cfi, data, uint32_t, found);
    426  1.1   cliff 	}
    427  1.1   cliff 
    428  1.1   cliff 	return found;
    429  1.1   cliff }
    430  1.1   cliff 
    431  1.1   cliff static bool
    432  1.1   cliff cfi_chip_query_8(struct cfi * const cfi)
    433  1.1   cliff {
    434  1.1   cliff #ifdef NOTYET
    435  1.1   cliff 	uint64_t data[0x80];
    436  1.1   cliff 
    437  1.1   cliff 	bus_space_read_region_8(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
    438  1.1   cliff 		__arraycount(data));
    439  1.1   cliff 
    440  1.4   cliff 	CFI_DUMP_QRY(0, data, sizeof(data), 8);
    441  1.4   cliff 
    442  1.1   cliff 	bool found = cfi_chip_query_opmode(cfi, (uint8_t *)data,
    443  1.1   cliff 		cfi_opmodes_8, __arraycount(cfi_opmodes_8));
    444  1.1   cliff 
    445  1.1   cliff 	if (found) {
    446  1.1   cliff 		CFI_QRY_UNPACK_COMMON(cfi, data, uint64_t, found);
    447  1.1   cliff 	}
    448  1.1   cliff 
    449  1.1   cliff 	return found;
    450  1.1   cliff #else
    451  1.1   cliff 	return false;
    452  1.1   cliff #endif
    453  1.1   cliff }
    454  1.1   cliff 
    455  1.1   cliff /*
    456  1.1   cliff  * cfi_chip_query - detect a CFI chip
    457  1.1   cliff  *
    458  1.1   cliff  * fill in the struct cfi as we discover what's there
    459  1.1   cliff  */
    460  1.1   cliff static bool
    461  1.1   cliff cfi_chip_query(struct cfi * const cfi)
    462  1.1   cliff {
    463  1.1   cliff 	bool found = false;
    464  1.1   cliff 	const bus_size_t cfi_query_offset[] = {
    465  1.1   cliff 		CFI_QUERY_MODE_ADDRESS,
    466  1.1   cliff 		CFI_QUERY_MODE_ALT_ADDRESS
    467  1.1   cliff 	};
    468  1.1   cliff 
    469  1.1   cliff 	KASSERT(cfi != NULL);
    470  1.1   cliff 	KASSERT(cfi->cfi_bst != NULL);
    471  1.1   cliff 
    472  1.1   cliff 	for (int j=0; !found && j < __arraycount(cfi_query_offset); j++) {
    473  1.1   cliff 
    474  1.1   cliff 		cfi_reset_default(cfi);
    475  1.1   cliff 		cfi_cmd(cfi, cfi_query_offset[j], CFI_QUERY_DATA);
    476  1.1   cliff 
    477  1.1   cliff 		switch(cfi->cfi_portwidth) {
    478  1.1   cliff 		case 0:
    479  1.1   cliff 			found = cfi_chip_query_1(cfi);
    480  1.1   cliff 			break;
    481  1.1   cliff 		case 1:
    482  1.1   cliff 			found = cfi_chip_query_2(cfi);
    483  1.1   cliff 			break;
    484  1.1   cliff 		case 2:
    485  1.1   cliff 			found = cfi_chip_query_4(cfi);
    486  1.1   cliff 			break;
    487  1.1   cliff 		case 3:
    488  1.1   cliff 			found = cfi_chip_query_8(cfi);
    489  1.1   cliff 			break;
    490  1.1   cliff 		default:
    491  1.1   cliff 			panic("%s: bad portwidth %d\n",
    492  1.1   cliff 				__func__, cfi->cfi_portwidth);
    493  1.1   cliff 		}
    494  1.1   cliff 	}
    495  1.1   cliff 
    496  1.4   cliff 	if (found)
    497  1.4   cliff 		cfi->cfi_emulated = false;
    498  1.4   cliff 
    499  1.1   cliff 	return found;
    500  1.1   cliff }
    501  1.1   cliff 
    502  1.1   cliff /*
    503  1.1   cliff  * cfi_probe - search for a CFI NOR trying various port & chip widths
    504  1.1   cliff  *
    505  1.4   cliff  * - gather CFI QRY and PRI data
    506  1.4   cliff  * - gather JEDEC ID data
    507  1.4   cliff  * - if cfi_chip_query() fails, emulate CFI using table data if possible,
    508  1.4   cliff  *   otherwise fail.
    509  1.4   cliff  *
    510  1.1   cliff  * NOTE:
    511  1.1   cliff  *   striped NOR chips design not supported yet,
    512  1.1   cliff  *   so force portwidth=chipwidth for now
    513  1.1   cliff  *   eventually permute portwidth seperately
    514  1.1   cliff  */
    515  1.1   cliff bool
    516  1.1   cliff cfi_probe(struct cfi * const cfi)
    517  1.1   cliff {
    518  1.1   cliff 	bool found;
    519  1.1   cliff 
    520  1.1   cliff 	KASSERT(cfi != NULL);
    521  1.1   cliff 
    522  1.1   cliff 	for (u_int cw = 0; cw < 3; cw++) {
    523  1.1   cliff 		cfi->cfi_portwidth = 		/* XXX */
    524  1.1   cliff 		cfi->cfi_chipwidth = cw;
    525  1.1   cliff 		found = cfi_chip_query(cfi);
    526  1.4   cliff 		cfi_jedec_id(cfi);
    527  1.4   cliff 		if (! found)
    528  1.4   cliff 			found = cfi_emulate(cfi);
    529  1.1   cliff 		if (found)
    530  1.4   cliff 			break;
    531  1.1   cliff 	}
    532  1.4   cliff 
    533  1.1   cliff 	cfi_reset_default(cfi);		/* exit QRY mode */
    534  1.1   cliff 	return found;
    535  1.1   cliff }
    536  1.1   cliff 
    537  1.1   cliff bool
    538  1.1   cliff cfi_identify(struct cfi * const cfi)
    539  1.1   cliff {
    540  1.1   cliff 	const bus_space_tag_t bst = cfi->cfi_bst;
    541  1.1   cliff 	const bus_space_handle_t bsh = cfi->cfi_bsh;
    542  1.4   cliff 	bool found;
    543  1.1   cliff 
    544  1.1   cliff 	KASSERT(cfi != NULL);
    545  1.1   cliff 	KASSERT(bst != NULL);
    546  1.1   cliff 
    547  1.1   cliff 	memset(cfi, 0, sizeof(struct cfi));	/* XXX clean slate */
    548  1.1   cliff 	cfi->cfi_bst = bst;		/* restore bus space */
    549  1.1   cliff 	cfi->cfi_bsh = bsh;		/*  "       "   "    */
    550  1.1   cliff 
    551  1.4   cliff 	found = cfi_probe(cfi);
    552  1.1   cliff 
    553  1.1   cliff 	cfi_reset_default(cfi);	/* exit QRY mode */
    554  1.1   cliff 
    555  1.1   cliff 	return found;
    556  1.1   cliff }
    557  1.1   cliff 
    558  1.1   cliff static int
    559  1.1   cliff cfi_scan_media(device_t self, struct nor_chip *chip)
    560  1.1   cliff {
    561  1.1   cliff 	struct nor_softc *sc = device_private(self);
    562  1.1   cliff 	KASSERT(sc != NULL);
    563  1.1   cliff 	KASSERT(sc->sc_nor_if != NULL);
    564  1.1   cliff 	struct cfi * const cfi = (struct cfi * const)sc->sc_nor_if->private;
    565  1.1   cliff 	KASSERT(cfi != NULL);
    566  1.1   cliff 
    567  1.1   cliff 	sc->sc_nor_if->access_width = cfi->cfi_portwidth;
    568  1.1   cliff 
    569  1.1   cliff 	chip->nc_manf_id = cfi->cfi_id_data.id_mid;
    570  1.1   cliff 	chip->nc_dev_id = cfi->cfi_id_data.id_did[0]; /* XXX 3 words */
    571  1.1   cliff 	chip->nc_size = 1 << cfi->cfi_qry_data.device_size;
    572  1.1   cliff 
    573  1.1   cliff 	/* size of line for Read Buf command */
    574  1.1   cliff 	chip->nc_line_size = 1 << cfi->cfi_qry_data.pri.cmd_0002.page_size;
    575  1.1   cliff 
    576  1.1   cliff 	/*
    577  1.1   cliff 	 * size of erase block
    578  1.1   cliff 	 * XXX depends on erase region
    579  1.1   cliff 	 */
    580  1.1   cliff 	chip->nc_num_luns = 1;
    581  1.1   cliff 	chip->nc_lun_blocks = cfi->cfi_qry_data.erase_blk_info[0].y + 1;
    582  1.1   cliff 	chip->nc_block_size = cfi->cfi_qry_data.erase_blk_info[0].z * 256;
    583  1.1   cliff 
    584  1.1   cliff 	switch (cfi->cfi_qry_data.id_pri) {
    585  1.1   cliff 	case 0x0002:
    586  1.1   cliff 		cfi_0002_init(sc, cfi, chip);
    587  1.1   cliff 		break;
    588  1.1   cliff 	default:
    589  1.4   cliff 		aprint_error_dev(self, "unsupported CFI cmdset %#04x\n",
    590  1.4   cliff 			cfi->cfi_qry_data.id_pri);
    591  1.1   cliff 		return -1;
    592  1.1   cliff 	}
    593  1.1   cliff 
    594  1.1   cliff 	return 0;
    595  1.1   cliff }
    596  1.1   cliff 
    597  1.1   cliff void
    598  1.1   cliff cfi_init(device_t self)
    599  1.1   cliff {
    600  1.1   cliff 	/* nothing */
    601  1.1   cliff }
    602  1.1   cliff 
    603  1.1   cliff static void
    604  1.1   cliff cfi_select(device_t self, bool select)
    605  1.1   cliff {
    606  1.1   cliff 	/* nothing */
    607  1.1   cliff }
    608  1.1   cliff 
    609  1.1   cliff static void
    610  1.1   cliff cfi_read_1(device_t self, flash_off_t offset, uint8_t *datap)
    611  1.1   cliff {
    612  1.1   cliff }
    613  1.1   cliff 
    614  1.1   cliff static void
    615  1.1   cliff cfi_read_2(device_t self, flash_off_t offset, uint16_t *datap)
    616  1.1   cliff {
    617  1.1   cliff }
    618  1.1   cliff 
    619  1.1   cliff static void
    620  1.1   cliff cfi_read_4(device_t self, flash_off_t offset, uint32_t *datap)
    621  1.1   cliff {
    622  1.1   cliff }
    623  1.1   cliff 
    624  1.1   cliff static void
    625  1.1   cliff cfi_read_buf_1(device_t self, flash_off_t offset, uint8_t *datap, size_t size)
    626  1.1   cliff {
    627  1.1   cliff }
    628  1.1   cliff 
    629  1.1   cliff static void
    630  1.1   cliff cfi_read_buf_2(device_t self, flash_off_t offset, uint16_t *datap, size_t size)
    631  1.1   cliff {
    632  1.1   cliff }
    633  1.1   cliff 
    634  1.1   cliff static void
    635  1.1   cliff cfi_read_buf_4(device_t self, flash_off_t offset, uint32_t *datap, size_t size)
    636  1.1   cliff {
    637  1.1   cliff }
    638  1.1   cliff 
    639  1.1   cliff static void
    640  1.1   cliff cfi_write_1(device_t self, flash_off_t offset, uint8_t data)
    641  1.1   cliff {
    642  1.1   cliff }
    643  1.1   cliff 
    644  1.1   cliff static void
    645  1.1   cliff cfi_write_2(device_t self, flash_off_t offset, uint16_t data)
    646  1.1   cliff {
    647  1.1   cliff }
    648  1.1   cliff 
    649  1.1   cliff static void
    650  1.1   cliff cfi_write_4(device_t self, flash_off_t offset, uint32_t data)
    651  1.1   cliff {
    652  1.1   cliff }
    653  1.1   cliff 
    654  1.1   cliff static void
    655  1.1   cliff cfi_write_buf_1(device_t self, flash_off_t offset, const uint8_t *datap,
    656  1.1   cliff     size_t size)
    657  1.1   cliff {
    658  1.1   cliff }
    659  1.1   cliff 
    660  1.1   cliff static void
    661  1.1   cliff cfi_write_buf_2(device_t self, flash_off_t offset, const uint16_t *datap,
    662  1.1   cliff     size_t size)
    663  1.1   cliff {
    664  1.1   cliff }
    665  1.1   cliff 
    666  1.1   cliff static void
    667  1.1   cliff cfi_write_buf_4(device_t self, flash_off_t offset, const uint32_t *datap,
    668  1.1   cliff     size_t size)
    669  1.1   cliff {
    670  1.1   cliff }
    671  1.1   cliff 
    672  1.1   cliff void
    673  1.1   cliff cfi_cmd(struct cfi * const cfi, bus_size_t off, uint32_t val)
    674  1.1   cliff {
    675  1.1   cliff 	const bus_space_tag_t bst = cfi->cfi_bst;
    676  1.1   cliff 	bus_space_handle_t bsh = cfi->cfi_bsh;
    677  1.1   cliff 
    678  1.1   cliff 	off <<= cfi->cfi_portwidth;
    679  1.1   cliff 
    680  1.1   cliff 	DPRINTF(("%s: %p %x %x %x\n", __func__, bst, bsh, off, val));
    681  1.1   cliff 
    682  1.1   cliff 	switch(cfi->cfi_portwidth) {
    683  1.1   cliff 	case 0:
    684  1.1   cliff 		bus_space_write_1(bst, bsh, off, (uint8_t)val);
    685  1.1   cliff 		break;
    686  1.1   cliff 	case 1:
    687  1.1   cliff 		bus_space_write_2(bst, bsh, off, val);
    688  1.1   cliff 		break;
    689  1.1   cliff 	case 2:
    690  1.1   cliff 		bus_space_write_4(bst, bsh, off, (uint32_t)val);
    691  1.1   cliff 		break;
    692  1.1   cliff #ifdef NOTYET
    693  1.1   cliff 	case 3:
    694  1.1   cliff 		bus_space_write_4(bst, bsh, off, (uint64_t)val);
    695  1.1   cliff 		break;
    696  1.1   cliff #endif
    697  1.1   cliff 	default:
    698  1.1   cliff 		panic("%s: bad portwidth %d bytes\n",
    699  1.1   cliff 			__func__, 1 << cfi->cfi_portwidth);
    700  1.1   cliff 	}
    701  1.1   cliff }
    702  1.1   cliff 
    703  1.1   cliff /*
    704  1.1   cliff  * cfi_reset_default - when we don't know which command will work, use both
    705  1.1   cliff  */
    706  1.1   cliff void
    707  1.1   cliff cfi_reset_default(struct cfi * const cfi)
    708  1.1   cliff {
    709  1.1   cliff 	cfi_cmd(cfi, CFI_ADDRESS_ANY, CFI_RESET_DATA);
    710  1.1   cliff 	cfi_cmd(cfi, CFI_ADDRESS_ANY, CFI_ALT_RESET_DATA);
    711  1.1   cliff }
    712  1.1   cliff 
    713  1.1   cliff /*
    714  1.1   cliff  * cfi_reset_std - use standard reset command
    715  1.1   cliff  */
    716  1.1   cliff void
    717  1.1   cliff cfi_reset_std(struct cfi * const cfi)
    718  1.1   cliff {
    719  1.1   cliff 	cfi_cmd(cfi, CFI_ADDRESS_ANY, CFI_RESET_DATA);
    720  1.1   cliff }
    721  1.1   cliff 
    722  1.1   cliff /*
    723  1.1   cliff  * cfi_reset_alt - use "alternate" reset command
    724  1.1   cliff  */
    725  1.1   cliff void
    726  1.1   cliff cfi_reset_alt(struct cfi * const cfi)
    727  1.1   cliff {
    728  1.1   cliff 	cfi_cmd(cfi, CFI_ADDRESS_ANY, CFI_ALT_RESET_DATA);
    729  1.1   cliff }
    730  1.1   cliff 
    731  1.1   cliff static void
    732  1.4   cliff cfi_jedec_id_1(struct cfi * const cfi)
    733  1.4   cliff {
    734  1.4   cliff 	struct cfi_jedec_id_data *idp = &cfi->cfi_id_data;
    735  1.4   cliff 	uint8_t data[0x10];
    736  1.4   cliff 
    737  1.4   cliff 	bus_space_read_region_1(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
    738  1.4   cliff 		__arraycount(data));
    739  1.4   cliff 
    740  1.4   cliff 	CFI_DUMP_JEDEC(0, data, sizeof(data), 1);
    741  1.4   cliff 
    742  1.4   cliff 	idp->id_mid = (uint16_t)data[0];
    743  1.4   cliff 	idp->id_did[0] = (uint16_t)data[1];
    744  1.4   cliff 	idp->id_did[1] = (uint16_t)data[0xe];
    745  1.4   cliff 	idp->id_did[2] = (uint16_t)data[0xf];
    746  1.4   cliff 	idp->id_prot_state = (uint16_t)data[2];
    747  1.4   cliff 	idp->id_indicators = (uint16_t)data[3];
    748  1.4   cliff 
    749  1.4   cliff 	/* software bits, upper and lower */
    750  1.4   cliff 	idp->id_swb_lo = data[0xc];
    751  1.4   cliff 	idp->id_swb_hi = data[0xd];
    752  1.4   cliff 
    753  1.4   cliff }
    754  1.4   cliff 
    755  1.4   cliff static void
    756  1.1   cliff cfi_jedec_id_2(struct cfi * const cfi)
    757  1.1   cliff {
    758  1.1   cliff 	struct cfi_jedec_id_data *idp = &cfi->cfi_id_data;
    759  1.1   cliff 	uint16_t data[0x10];
    760  1.1   cliff 
    761  1.1   cliff 	bus_space_read_region_2(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
    762  1.1   cliff 		__arraycount(data));
    763  1.1   cliff 
    764  1.4   cliff 	CFI_DUMP_JEDEC(0, data, sizeof(data), 1);
    765  1.4   cliff 
    766  1.1   cliff 	idp->id_mid = data[0];
    767  1.1   cliff 	idp->id_did[0] = data[1];
    768  1.1   cliff 	idp->id_did[1] = data[0xe];
    769  1.1   cliff 	idp->id_did[2] = data[0xf];
    770  1.1   cliff 	idp->id_prot_state = data[2];
    771  1.1   cliff 	idp->id_indicators = data[3];
    772  1.1   cliff 
    773  1.1   cliff 	/* software bits, upper and lower
    774  1.1   cliff 	 * - undefined on S29GL-P
    775  1.1   cliff 	 * - defined   on S29GL-S
    776  1.1   cliff 	 */
    777  1.1   cliff 	idp->id_swb_lo = data[0xc];
    778  1.1   cliff 	idp->id_swb_hi = data[0xd];
    779  1.4   cliff 
    780  1.4   cliff }
    781  1.4   cliff 
    782  1.4   cliff static void
    783  1.4   cliff cfi_jedec_id_4(struct cfi * const cfi)
    784  1.4   cliff {
    785  1.4   cliff 	struct cfi_jedec_id_data *idp = &cfi->cfi_id_data;
    786  1.4   cliff 	uint32_t data[0x10];
    787  1.4   cliff 
    788  1.4   cliff 	bus_space_read_region_4(cfi->cfi_bst, cfi->cfi_bsh, 0, data,
    789  1.4   cliff 		__arraycount(data));
    790  1.4   cliff 
    791  1.4   cliff 	CFI_DUMP_JEDEC(0, data, sizeof(data), 1);
    792  1.4   cliff 
    793  1.4   cliff 	idp->id_mid = data[0] & 0xffff;
    794  1.4   cliff 	idp->id_did[0] = data[1] & 0xffff;
    795  1.4   cliff 	idp->id_did[1] = data[0xe] & 0xffff;
    796  1.4   cliff 	idp->id_did[2] = data[0xf] & 0xffff;
    797  1.4   cliff 	idp->id_prot_state = data[2] & 0xffff;
    798  1.4   cliff 	idp->id_indicators = data[3] & 0xffff;
    799  1.4   cliff 
    800  1.4   cliff 	/* software bits, upper and lower
    801  1.4   cliff 	 * - undefined on S29GL-P
    802  1.4   cliff 	 * - defined   on S29GL-S
    803  1.4   cliff 	 */
    804  1.4   cliff 	idp->id_swb_lo = data[0xc] & 0xffff;
    805  1.4   cliff 	idp->id_swb_hi = data[0xd] & 0xffff;
    806  1.4   cliff 
    807  1.1   cliff }
    808  1.1   cliff 
    809  1.1   cliff /*
    810  1.1   cliff  * cfi_jedec_id - get JEDEC ID info
    811  1.1   cliff  */
    812  1.1   cliff static bool
    813  1.1   cliff cfi_jedec_id(struct cfi * const cfi)
    814  1.1   cliff {
    815  1.4   cliff 
    816  1.1   cliff 	DPRINTF(("%s\n", __func__));
    817  1.1   cliff 
    818  1.1   cliff 	cfi_cmd(cfi, 0x555, 0xaa);
    819  1.1   cliff 	cfi_cmd(cfi, 0x2aa, 0x55);
    820  1.1   cliff 	cfi_cmd(cfi, 0x555, 0x90);
    821  1.1   cliff 
    822  1.1   cliff 	switch(cfi->cfi_portwidth) {
    823  1.4   cliff 	case 0:
    824  1.4   cliff 		cfi_jedec_id_1(cfi);
    825  1.4   cliff 		break;
    826  1.1   cliff 	case 1:
    827  1.1   cliff 		cfi_jedec_id_2(cfi);
    828  1.1   cliff 		break;
    829  1.1   cliff 	case 2:
    830  1.1   cliff 		cfi_jedec_id_4(cfi);
    831  1.1   cliff 		break;
    832  1.4   cliff #ifdef NOTYET
    833  1.1   cliff 	case 3:
    834  1.1   cliff 		cfi_jedec_id_8(cfi);
    835  1.1   cliff 		break;
    836  1.1   cliff #endif
    837  1.1   cliff 	default:
    838  1.1   cliff 		panic("%s: bad portwidth %d bytes\n",
    839  1.1   cliff 			__func__, 1 << cfi->cfi_portwidth);
    840  1.1   cliff 	}
    841  1.1   cliff 
    842  1.1   cliff 	return true;
    843  1.1   cliff }
    844  1.1   cliff 
    845  1.4   cliff static bool
    846  1.4   cliff cfi_emulate(struct cfi * const cfi)
    847  1.4   cliff {
    848  1.4   cliff 	bool found = false;
    849  1.4   cliff 	const struct cfi_jedec_tab *jt = cfi_jedec_search(cfi);
    850  1.4   cliff 	if (jt != NULL) {
    851  1.4   cliff 		found = true;
    852  1.4   cliff 		cfi->cfi_emulated = true;
    853  1.4   cliff 		cfi_jedec_fill(cfi, jt);
    854  1.4   cliff 	}
    855  1.4   cliff 	return found;
    856  1.4   cliff }
    857  1.4   cliff 
    858  1.4   cliff /*
    859  1.4   cliff  * cfi_jedec_search - search cfi_jedec_tab[] for entry matching given JEDEC IDs
    860  1.4   cliff  */
    861  1.4   cliff static const struct cfi_jedec_tab *
    862  1.4   cliff cfi_jedec_search(struct cfi *cfi)
    863  1.4   cliff {
    864  1.4   cliff 	struct cfi_jedec_id_data *idp = &cfi->cfi_id_data;
    865  1.4   cliff 
    866  1.4   cliff 	for (u_int i=0; i < __arraycount(cfi_jedec_tab); i++) {
    867  1.4   cliff 		const struct cfi_jedec_tab *jt = &cfi_jedec_tab[i];
    868  1.4   cliff 		if ((jt->jt_mid == idp->id_mid) &&
    869  1.4   cliff 		    (jt->jt_did == idp->id_did[0])) {
    870  1.4   cliff 			return jt;
    871  1.4   cliff 		}
    872  1.4   cliff 	}
    873  1.4   cliff 	return NULL;
    874  1.4   cliff }
    875  1.4   cliff 
    876  1.4   cliff /*
    877  1.4   cliff  * cfi_jedec_fill - fill in cfi with info from table entry
    878  1.4   cliff  */
    879  1.4   cliff static void
    880  1.4   cliff cfi_jedec_fill(struct cfi *cfi, const struct cfi_jedec_tab *jt)
    881  1.4   cliff {
    882  1.5   cliff 
    883  1.4   cliff 	cfi->cfi_name = jt->jt_name;
    884  1.4   cliff 	cfi->cfi_opmode = jt->jt_opmode;
    885  1.5   cliff 
    886  1.5   cliff 	struct cfi_query_data *qryp = &cfi->cfi_qry_data;
    887  1.5   cliff 	memset(&qryp, 0, sizeof(*qryp));
    888  1.5   cliff 	qryp->id_pri = jt->jt_id_pri;
    889  1.5   cliff 	qryp->id_alt = jt->jt_id_alt;
    890  1.5   cliff 	qryp->interface_code_desc = jt->jt_interface_code_desc;
    891  1.5   cliff 	qryp->write_word_time_typ = jt->jt_write_word_time_typ;
    892  1.5   cliff 	qryp->write_nbyte_time_typ = jt->jt_write_nbyte_time_typ;
    893  1.5   cliff 	qryp->erase_blk_time_typ = jt->jt_erase_blk_time_typ;
    894  1.5   cliff 	qryp->erase_chip_time_typ = jt->jt_erase_chip_time_typ;
    895  1.5   cliff 	qryp->write_word_time_max = jt->jt_write_word_time_max;
    896  1.5   cliff 	qryp->write_nbyte_time_max = jt->jt_write_nbyte_time_max;
    897  1.5   cliff 	qryp->erase_blk_time_max = jt->jt_erase_blk_time_max;
    898  1.5   cliff 	qryp->erase_chip_time_max = jt->jt_erase_chip_time_max;
    899  1.5   cliff 	qryp->device_size = jt->jt_device_size;
    900  1.5   cliff 	qryp->interface_code_desc = jt->jt_interface_code_desc;
    901  1.5   cliff 	qryp->write_nbyte_size_max = jt->jt_write_nbyte_size_max;
    902  1.5   cliff 	qryp->erase_blk_regions = jt->jt_erase_blk_regions;
    903  1.4   cliff 	for (u_int i=0; i < 4; i++)
    904  1.5   cliff 		qryp->erase_blk_info[i] = jt->jt_erase_blk_info[i];
    905  1.5   cliff 
    906  1.4   cliff }
    907  1.4   cliff 
    908  1.1   cliff void
    909  1.1   cliff cfi_print(device_t self, struct cfi * const cfi)
    910  1.1   cliff {
    911  1.1   cliff 	char pbuf[sizeof("XXXX MB")];
    912  1.1   cliff 	struct cfi_query_data * const qryp = &cfi->cfi_qry_data;
    913  1.1   cliff 
    914  1.1   cliff 	format_bytes(pbuf, sizeof(pbuf), 1 << qryp->device_size);
    915  1.4   cliff 	if (cfi->cfi_emulated) {
    916  1.4   cliff 		aprint_normal_dev(self, "%s NOR flash %s %s\n",
    917  1.4   cliff 			cfi->cfi_name, pbuf,
    918  1.4   cliff 			cfi_interface_desc_str(qryp->interface_code_desc));
    919  1.4   cliff 	} else {
    920  1.4   cliff 		aprint_normal_dev(self, "CFI NOR flash %s %s\n", pbuf,
    921  1.4   cliff 			cfi_interface_desc_str(qryp->interface_code_desc));
    922  1.4   cliff 	}
    923  1.1   cliff #ifdef NOR_VERBOSE
    924  1.1   cliff 	aprint_normal_dev(self, "manufacturer id %#x, device id %#x %#x %#x\n",
    925  1.1   cliff 		cfi->cfi_id_data.id_mid,
    926  1.1   cliff 		cfi->cfi_id_data.id_did[0],
    927  1.1   cliff 		cfi->cfi_id_data.id_did[1],
    928  1.1   cliff 		cfi->cfi_id_data.id_did[2]);
    929  1.1   cliff 	aprint_normal_dev(self, "%s\n", cfi->cfi_opmode->str);
    930  1.1   cliff 	aprint_normal_dev(self, "sw bits lo=%#x hi=%#x\n",
    931  1.1   cliff 		cfi->cfi_id_data.id_swb_lo,
    932  1.1   cliff 		cfi->cfi_id_data.id_swb_hi);
    933  1.1   cliff 	aprint_normal_dev(self, "max multibyte write size %d\n",
    934  1.1   cliff 		1 << qryp->write_nbyte_size_max);
    935  1.1   cliff 	aprint_normal_dev(self, "%d Erase Block Region(s)\n",
    936  1.1   cliff 		qryp->erase_blk_regions);
    937  1.1   cliff 	for (u_int r=0; r < qryp->erase_blk_regions; r++) {
    938  1.1   cliff 		size_t sz = qryp->erase_blk_info[r].z * 256;
    939  1.1   cliff 		format_bytes(pbuf, sizeof(pbuf), sz);
    940  1.1   cliff 		aprint_normal("    %d: %d blocks, size %s\n", r,
    941  1.1   cliff 			qryp->erase_blk_info[r].y + 1, pbuf);
    942  1.1   cliff 	}
    943  1.1   cliff #endif
    944  1.1   cliff 
    945  1.1   cliff 	switch (cfi->cfi_qry_data.id_pri) {
    946  1.1   cliff 	case 0x0002:
    947  1.1   cliff 		cfi_0002_print(self, cfi);
    948  1.1   cliff 		break;
    949  1.1   cliff 	}
    950  1.1   cliff }
    951  1.4   cliff 
    952  1.4   cliff #if defined(CFI_DEBUG_JEDEC) || defined(CFI_DEBUG_QRY)
    953  1.4   cliff void
    954  1.4   cliff cfi_hexdump(flash_off_t offset, void * const v, u_int count, u_int stride)
    955  1.4   cliff {
    956  1.4   cliff 	uint8_t * const data = v;
    957  1.4   cliff 	for(int n=0; n < count; n+=16) {
    958  1.4   cliff 		int i;
    959  1.4   cliff 		printf("%08llx: ", (offset + n) / stride);
    960  1.4   cliff 		for(i=n; i < n+16; i++)
    961  1.4   cliff 			printf("%02x ", data[i]);
    962  1.4   cliff 		printf("\t");
    963  1.4   cliff 		for(i=n; i < n+16; i++) {
    964  1.4   cliff 			u_int c = (int)data[i];
    965  1.4   cliff 			if (c >= 0x20 && c < 0x7f)
    966  1.4   cliff 				printf("%c", c);
    967  1.4   cliff 			else
    968  1.4   cliff 				printf("%c", '.');
    969  1.4   cliff 		}
    970  1.4   cliff 		printf("\n");
    971  1.4   cliff 	}
    972  1.4   cliff }
    973  1.4   cliff #endif
    974