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