Home | History | Annotate | Line # | Download | only in eisa
eisa_machdep.c revision 1.6
      1  1.6  tsutsui /* $NetBSD: eisa_machdep.c,v 1.6 2007/07/22 02:14:39 tsutsui Exp $ */
      2  1.1  thorpej 
      3  1.1  thorpej /*-
      4  1.1  thorpej  * Copyright (c) 2000 The NetBSD Foundation, Inc.
      5  1.1  thorpej  * All rights reserved.
      6  1.1  thorpej  *
      7  1.1  thorpej  * This code is derived from software contributed to The NetBSD Foundation
      8  1.1  thorpej  * by Jason R. Thorpe.
      9  1.1  thorpej  *
     10  1.1  thorpej  * Redistribution and use in source and binary forms, with or without
     11  1.1  thorpej  * modification, are permitted provided that the following conditions
     12  1.1  thorpej  * are met:
     13  1.1  thorpej  * 1. Redistributions of source code must retain the above copyright
     14  1.1  thorpej  *    notice, this list of conditions and the following disclaimer.
     15  1.1  thorpej  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1  thorpej  *    notice, this list of conditions and the following disclaimer in the
     17  1.1  thorpej  *    documentation and/or other materials provided with the distribution.
     18  1.1  thorpej  * 3. All advertising materials mentioning features or use of this software
     19  1.1  thorpej  *    must display the following acknowledgement:
     20  1.1  thorpej  *	This product includes software developed by the NetBSD
     21  1.1  thorpej  *	Foundation, Inc. and its contributors.
     22  1.1  thorpej  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  1.1  thorpej  *    contributors may be used to endorse or promote products derived
     24  1.1  thorpej  *    from this software without specific prior written permission.
     25  1.1  thorpej  *
     26  1.1  thorpej  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  1.1  thorpej  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  1.1  thorpej  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  1.1  thorpej  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  1.1  thorpej  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  1.1  thorpej  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  1.1  thorpej  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  1.1  thorpej  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  1.1  thorpej  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  1.1  thorpej  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  1.1  thorpej  * POSSIBILITY OF SUCH DAMAGE.
     37  1.1  thorpej  */
     38  1.1  thorpej 
     39  1.1  thorpej #include <sys/cdefs.h>
     40  1.1  thorpej 
     41  1.6  tsutsui __KERNEL_RCSID(0, "$NetBSD: eisa_machdep.c,v 1.6 2007/07/22 02:14:39 tsutsui Exp $");
     42  1.1  thorpej 
     43  1.1  thorpej #include <sys/param.h>
     44  1.1  thorpej #include <sys/systm.h>
     45  1.1  thorpej #include <sys/device.h>
     46  1.1  thorpej #include <sys/malloc.h>
     47  1.1  thorpej #include <sys/queue.h>
     48  1.1  thorpej 
     49  1.1  thorpej #include <machine/intr.h>
     50  1.1  thorpej #include <machine/rpb.h>
     51  1.1  thorpej 
     52  1.1  thorpej #include <dev/eisa/eisareg.h>
     53  1.1  thorpej #include <dev/eisa/eisavar.h>
     54  1.1  thorpej 
     55  1.1  thorpej #define	EISA_SLOT_HEADER_SIZE	31
     56  1.1  thorpej #define	EISA_SLOT_INFO_OFFSET	20
     57  1.1  thorpej 
     58  1.1  thorpej #define	EISA_FUNC_INFO_OFFSET	34
     59  1.1  thorpej #define	EISA_CONFIG_BLOCK_SIZE	320
     60  1.1  thorpej 
     61  1.1  thorpej #define	ECUF_TYPE_STRING	0x01
     62  1.1  thorpej #define	ECUF_MEM_ENTRY		0x02
     63  1.1  thorpej #define	ECUF_IRQ_ENTRY		0x04
     64  1.1  thorpej #define	ECUF_DMA_ENTRY		0x08
     65  1.1  thorpej #define	ECUF_IO_ENTRY		0x10
     66  1.1  thorpej #define	ECUF_INIT_ENTRY		0x20
     67  1.1  thorpej #define	ECUF_DISABLED		0x80
     68  1.1  thorpej 
     69  1.1  thorpej #define	ECUF_SELECTIONS_SIZE	26
     70  1.1  thorpej #define	ECUF_TYPE_STRING_SIZE	80
     71  1.1  thorpej #define	ECUF_MEM_ENTRY_SIZE	7
     72  1.1  thorpej #define	ECUF_IRQ_ENTRY_SIZE	2
     73  1.1  thorpej #define	ECUF_DMA_ENTRY_SIZE	2
     74  1.1  thorpej #define	ECUF_IO_ENTRY_SIZE	3
     75  1.1  thorpej #define	ECUF_INIT_ENTRY_SIZE	60
     76  1.1  thorpej 
     77  1.1  thorpej #define	ECUF_MEM_ENTRY_CNT	9
     78  1.1  thorpej #define	ECUF_IRQ_ENTRY_CNT	7
     79  1.1  thorpej #define	ECUF_DMA_ENTRY_CNT	4
     80  1.1  thorpej #define	ECUF_IO_ENTRY_CNT	20
     81  1.1  thorpej 
     82  1.6  tsutsui #define	CBUFSIZE		512
     83  1.6  tsutsui 
     84  1.1  thorpej /*
     85  1.1  thorpej  * EISA configuration space, as set up by the ECU, may be sparse.
     86  1.1  thorpej  */
     87  1.1  thorpej bus_size_t eisa_config_stride;
     88  1.1  thorpej paddr_t eisa_config_addr;		/* defaults to 0 */
     89  1.1  thorpej paddr_t eisa_config_header_addr;
     90  1.1  thorpej 
     91  1.1  thorpej struct ecu_mem {
     92  1.1  thorpej 	SIMPLEQ_ENTRY(ecu_mem) ecum_list;
     93  1.2  thorpej 	struct eisa_cfg_mem ecum_mem;
     94  1.1  thorpej };
     95  1.1  thorpej 
     96  1.1  thorpej struct ecu_irq {
     97  1.1  thorpej 	SIMPLEQ_ENTRY(ecu_irq) ecui_list;
     98  1.2  thorpej 	struct eisa_cfg_irq ecui_irq;
     99  1.1  thorpej };
    100  1.1  thorpej 
    101  1.1  thorpej struct ecu_dma {
    102  1.1  thorpej 	SIMPLEQ_ENTRY(ecu_dma) ecud_list;
    103  1.2  thorpej 	struct eisa_cfg_dma ecud_dma;
    104  1.1  thorpej };
    105  1.1  thorpej 
    106  1.1  thorpej struct ecu_io {
    107  1.1  thorpej 	SIMPLEQ_ENTRY(ecu_io) ecuio_list;
    108  1.2  thorpej 	struct eisa_cfg_io ecuio_io;
    109  1.1  thorpej };
    110  1.1  thorpej 
    111  1.1  thorpej struct ecu_func {
    112  1.1  thorpej 	SIMPLEQ_ENTRY(ecu_func) ecuf_list;
    113  1.1  thorpej 	int ecuf_funcno;
    114  1.1  thorpej 	u_int32_t ecuf_id;
    115  1.1  thorpej 	u_int16_t ecuf_slot_info;
    116  1.1  thorpej 	u_int16_t ecuf_cfg_ext;
    117  1.1  thorpej 	u_int8_t ecuf_selections[ECUF_SELECTIONS_SIZE];
    118  1.1  thorpej 	u_int8_t ecuf_func_info;
    119  1.1  thorpej 	u_int8_t ecuf_type_string[ECUF_TYPE_STRING_SIZE];
    120  1.1  thorpej 	u_int8_t ecuf_init[ECUF_INIT_ENTRY_SIZE];
    121  1.1  thorpej 	SIMPLEQ_HEAD(, ecu_mem) ecuf_mem;
    122  1.1  thorpej 	SIMPLEQ_HEAD(, ecu_irq) ecuf_irq;
    123  1.1  thorpej 	SIMPLEQ_HEAD(, ecu_dma) ecuf_dma;
    124  1.1  thorpej 	SIMPLEQ_HEAD(, ecu_io) ecuf_io;
    125  1.1  thorpej };
    126  1.1  thorpej 
    127  1.1  thorpej struct ecu_data {
    128  1.1  thorpej 	SIMPLEQ_ENTRY(ecu_data) ecud_list;
    129  1.1  thorpej 	int ecud_slot;
    130  1.1  thorpej 	u_int8_t ecud_eisaid[EISA_IDSTRINGLEN];
    131  1.1  thorpej 	u_int32_t ecud_offset;
    132  1.1  thorpej 
    133  1.1  thorpej 	/* General slot info. */
    134  1.1  thorpej 	u_int8_t ecud_slot_info;
    135  1.1  thorpej 	u_int16_t ecud_ecu_major_rev;
    136  1.1  thorpej 	u_int16_t ecud_ecu_minor_rev;
    137  1.1  thorpej 	u_int16_t ecud_cksum;
    138  1.1  thorpej 	u_int16_t ecud_ndevfuncs;
    139  1.1  thorpej 	u_int8_t ecud_funcinfo;
    140  1.1  thorpej 	u_int32_t ecud_comp_id;
    141  1.1  thorpej 
    142  1.1  thorpej 	/* The functions */
    143  1.1  thorpej 	SIMPLEQ_HEAD(, ecu_func) ecud_funcs;
    144  1.1  thorpej };
    145  1.1  thorpej 
    146  1.1  thorpej SIMPLEQ_HEAD(, ecu_data) ecu_data_list =
    147  1.1  thorpej     SIMPLEQ_HEAD_INITIALIZER(ecu_data_list);
    148  1.1  thorpej 
    149  1.1  thorpej static void
    150  1.1  thorpej ecuf_init(struct ecu_func *ecuf)
    151  1.1  thorpej {
    152  1.1  thorpej 
    153  1.1  thorpej 	memset(ecuf, 0, sizeof(*ecuf));
    154  1.1  thorpej 	SIMPLEQ_INIT(&ecuf->ecuf_mem);
    155  1.1  thorpej 	SIMPLEQ_INIT(&ecuf->ecuf_irq);
    156  1.1  thorpej 	SIMPLEQ_INIT(&ecuf->ecuf_dma);
    157  1.1  thorpej 	SIMPLEQ_INIT(&ecuf->ecuf_io);
    158  1.1  thorpej }
    159  1.1  thorpej 
    160  1.1  thorpej static void
    161  1.1  thorpej eisa_parse_mem(struct ecu_func *ecuf, u_int8_t *dp)
    162  1.1  thorpej {
    163  1.1  thorpej 	struct ecu_mem *ecum;
    164  1.1  thorpej 	int i;
    165  1.1  thorpej 
    166  1.1  thorpej 	for (i = 0; i < ECUF_MEM_ENTRY_CNT; i++) {
    167  1.6  tsutsui 		ecum = malloc(sizeof(*ecum), M_DEVBUF, M_ZERO|M_WAITOK);
    168  1.6  tsutsui 		if (ecum == NULL)
    169  1.6  tsutsui 			panic("%s: can't allocate memory for ecum", __func__);
    170  1.1  thorpej 
    171  1.2  thorpej 		ecum->ecum_mem.ecm_isram = dp[0] & 0x1;
    172  1.2  thorpej 		ecum->ecum_mem.ecm_unitsize = dp[1] & 0x3;
    173  1.2  thorpej 		ecum->ecum_mem.ecm_decode = (dp[1] >> 2) & 0x3;
    174  1.2  thorpej 		ecum->ecum_mem.ecm_addr =
    175  1.2  thorpej 		    (dp[2] | (dp[3] << 8) | (dp[4] << 16)) << 8;
    176  1.2  thorpej 		ecum->ecum_mem.ecm_size = (dp[5] | (dp[6] << 8)) << 10;
    177  1.2  thorpej 		if (ecum->ecum_mem.ecm_size == 0)
    178  1.2  thorpej 			ecum->ecum_mem.ecm_size = (1 << 26);
    179  1.1  thorpej 		SIMPLEQ_INSERT_TAIL(&ecuf->ecuf_mem, ecum, ecum_list);
    180  1.1  thorpej 
    181  1.6  tsutsui #ifdef EISA_DEBUG
    182  1.1  thorpej 		printf("MEM 0x%lx 0x%lx %d %d %d\n",
    183  1.2  thorpej 		    ecum->ecum_mem.ecm_addr, ecum->ecum_mem.ecm_size,
    184  1.2  thorpej 		    ecum->ecum_mem.ecm_isram, ecum->ecum_mem.ecm_unitsize,
    185  1.2  thorpej 		    ecum->ecum_mem.ecm_decode);
    186  1.1  thorpej #endif
    187  1.1  thorpej 
    188  1.1  thorpej 		if ((dp[0] & 0x80) == 0)
    189  1.1  thorpej 			break;
    190  1.1  thorpej 		dp += ECUF_MEM_ENTRY_SIZE;
    191  1.1  thorpej 	}
    192  1.1  thorpej }
    193  1.1  thorpej 
    194  1.1  thorpej static void
    195  1.1  thorpej eisa_parse_irq(struct ecu_func *ecuf, u_int8_t *dp)
    196  1.1  thorpej {
    197  1.1  thorpej 	struct ecu_irq *ecui;
    198  1.1  thorpej 	int i;
    199  1.1  thorpej 
    200  1.1  thorpej 	for (i = 0; i < ECUF_IRQ_ENTRY_CNT; i++) {
    201  1.6  tsutsui 		ecui = malloc(sizeof(*ecui), M_DEVBUF, M_ZERO|M_WAITOK);
    202  1.6  tsutsui 		if (ecui == NULL)
    203  1.6  tsutsui 			panic("%s: can't allocate memory for ecui", __func__);
    204  1.1  thorpej 
    205  1.2  thorpej 		ecui->ecui_irq.eci_irq = dp[0] & 0xf;
    206  1.2  thorpej 		ecui->ecui_irq.eci_ist = (dp[0] & 0x20) ? IST_LEVEL : IST_EDGE;
    207  1.2  thorpej 		ecui->ecui_irq.eci_shared = (dp[0] & 0x40) ? 1 : 0;
    208  1.1  thorpej 		SIMPLEQ_INSERT_TAIL(&ecuf->ecuf_irq, ecui, ecui_list);
    209  1.1  thorpej 
    210  1.6  tsutsui #ifdef EISA_DEBUG
    211  1.6  tsutsui 		printf("IRQ %d %s%s\n", ecui->ecui_irq.eci_irq,
    212  1.6  tsutsui 		    ecui->ecui_irq.eci_ist == IST_LEVEL ? "level" : "edge",
    213  1.6  tsutsui 		    ecui->ecui_irq.eci_shared ? " shared" : "");
    214  1.1  thorpej #endif
    215  1.1  thorpej 
    216  1.1  thorpej 		if ((dp[0] & 0x80) == 0)
    217  1.1  thorpej 			break;
    218  1.1  thorpej 		dp += ECUF_IRQ_ENTRY_SIZE;
    219  1.1  thorpej 	}
    220  1.1  thorpej }
    221  1.1  thorpej 
    222  1.1  thorpej static void
    223  1.1  thorpej eisa_parse_dma(struct ecu_func *ecuf, u_int8_t *dp)
    224  1.1  thorpej {
    225  1.1  thorpej 	struct ecu_dma *ecud;
    226  1.1  thorpej 	int i;
    227  1.1  thorpej 
    228  1.1  thorpej 	for (i = 0; i < ECUF_DMA_ENTRY_CNT; i++) {
    229  1.6  tsutsui 		ecud = malloc(sizeof(*ecud), M_DEVBUF, M_ZERO|M_WAITOK);
    230  1.6  tsutsui 		if (ecud == NULL)
    231  1.6  tsutsui 			panic("%s: can't allocate memory for ecud", __func__);
    232  1.1  thorpej 
    233  1.2  thorpej 		ecud->ecud_dma.ecd_drq = dp[0] & 0x7;
    234  1.2  thorpej 		ecud->ecud_dma.ecd_shared = dp[0] & 0x40;
    235  1.2  thorpej 		ecud->ecud_dma.ecd_size = (dp[1] >> 2) & 0x3;
    236  1.2  thorpej 		ecud->ecud_dma.ecd_timing = (dp[1] >> 4) & 0x3;
    237  1.1  thorpej 		SIMPLEQ_INSERT_TAIL(&ecuf->ecuf_dma, ecud, ecud_list);
    238  1.1  thorpej 
    239  1.6  tsutsui #ifdef EISA_DEBUG
    240  1.2  thorpej 		printf("DRQ %d%s %d %d\n", ecud->ecud_dma.ecd_drq,
    241  1.2  thorpej 		    ecud->ecud_dma.ecd_shared ? " shared" : "",
    242  1.2  thorpej 		    ecud->ecud_dma.ecd_size, ecud->ecud_dma.ecd_timing);
    243  1.1  thorpej #endif
    244  1.1  thorpej 
    245  1.1  thorpej 		if ((dp[0] & 0x80) == 0)
    246  1.1  thorpej 			break;
    247  1.1  thorpej 		dp += ECUF_DMA_ENTRY_SIZE;
    248  1.1  thorpej 	}
    249  1.1  thorpej }
    250  1.1  thorpej 
    251  1.1  thorpej static void
    252  1.1  thorpej eisa_parse_io(struct ecu_func *ecuf, u_int8_t *dp)
    253  1.1  thorpej {
    254  1.1  thorpej 	struct ecu_io *ecuio;
    255  1.1  thorpej 	int i;
    256  1.1  thorpej 
    257  1.1  thorpej 	for (i = 0; i < ECUF_IO_ENTRY_CNT; i++) {
    258  1.6  tsutsui 		ecuio = malloc(sizeof(*ecuio), M_DEVBUF, M_ZERO|M_WAITOK);
    259  1.6  tsutsui 		if (ecuio == NULL)
    260  1.6  tsutsui 			panic("%s: can't allocate memory for ecuio", __func__);
    261  1.1  thorpej 
    262  1.2  thorpej 		ecuio->ecuio_io.ecio_addr = dp[1] | (dp[2] << 8);
    263  1.2  thorpej 		ecuio->ecuio_io.ecio_size = (dp[0] & 0x1f) + 1;
    264  1.2  thorpej 		ecuio->ecuio_io.ecio_shared = (dp[0] & 0x40) ? 1 : 0;
    265  1.1  thorpej 
    266  1.6  tsutsui #ifdef EISA_DEBUG
    267  1.2  thorpej 		printf("IO 0x%lx 0x%lx%s\n", ecuio->ecuio_io.ecio_addr,
    268  1.2  thorpej 		    ecuio->ecuio_io.ecio_size,
    269  1.2  thorpej 		    ecuio->ecuio_io.ecio_shared ? " shared" : "");
    270  1.1  thorpej #endif
    271  1.1  thorpej 
    272  1.1  thorpej 		if ((dp[0] & 0x80) == 0)
    273  1.1  thorpej 			break;
    274  1.1  thorpej 		dp += ECUF_IO_ENTRY_SIZE;
    275  1.1  thorpej 	}
    276  1.1  thorpej }
    277  1.1  thorpej 
    278  1.1  thorpej static void
    279  1.1  thorpej eisa_read_config_bytes(paddr_t addr, void *buf, size_t count)
    280  1.1  thorpej {
    281  1.1  thorpej 	const u_int8_t *src = (const u_int8_t *)ALPHA_PHYS_TO_K0SEG(addr);
    282  1.1  thorpej 	u_int8_t *dst = buf;
    283  1.1  thorpej 
    284  1.1  thorpej 	for (; count != 0; count--) {
    285  1.1  thorpej 		*dst++ = *src;
    286  1.1  thorpej 		src += eisa_config_stride;
    287  1.1  thorpej 	}
    288  1.1  thorpej }
    289  1.1  thorpej 
    290  1.1  thorpej static void
    291  1.1  thorpej eisa_read_config_word(paddr_t addr, u_int32_t *valp)
    292  1.1  thorpej {
    293  1.1  thorpej 	const u_int8_t *src = (const u_int8_t *)ALPHA_PHYS_TO_K0SEG(addr);
    294  1.1  thorpej 	u_int32_t val = 0;
    295  1.1  thorpej 	int i;
    296  1.1  thorpej 
    297  1.1  thorpej 	for (i = 0; i < sizeof(val); i++) {
    298  1.6  tsutsui 		val |= (uint32_t)*src << (i * 8);
    299  1.1  thorpej 		src += eisa_config_stride;
    300  1.1  thorpej 	}
    301  1.1  thorpej 
    302  1.1  thorpej 	*valp = val;
    303  1.1  thorpej }
    304  1.1  thorpej 
    305  1.1  thorpej static size_t
    306  1.1  thorpej eisa_uncompress(void *cbufp, void *ucbufp, size_t count)
    307  1.1  thorpej {
    308  1.1  thorpej 	const u_int8_t *cbuf = cbufp;
    309  1.1  thorpej 	u_int8_t *ucbuf = ucbufp;
    310  1.1  thorpej 	u_int zeros = 0;
    311  1.1  thorpej 
    312  1.1  thorpej 	while (count--) {
    313  1.1  thorpej 		if (zeros) {
    314  1.1  thorpej 			zeros--;
    315  1.1  thorpej 			*ucbuf++ = '\0';
    316  1.1  thorpej 		} else if (*cbuf == '\0') {
    317  1.1  thorpej 			*ucbuf++ = *cbuf++;
    318  1.1  thorpej 			zeros = *cbuf++ - 1;
    319  1.1  thorpej 		} else
    320  1.1  thorpej 			*ucbuf++ = *cbuf++;
    321  1.1  thorpej 	}
    322  1.1  thorpej 
    323  1.1  thorpej 	return ((size_t)cbuf - (size_t)cbufp);
    324  1.1  thorpej }
    325  1.1  thorpej 
    326  1.1  thorpej void
    327  1.6  tsutsui eisa_init(eisa_chipset_tag_t ec)
    328  1.1  thorpej {
    329  1.1  thorpej 	struct ecu_data *ecud;
    330  1.1  thorpej 	paddr_t cfgaddr;
    331  1.1  thorpej 	u_int32_t offset;
    332  1.1  thorpej 	u_int8_t eisaid[EISA_IDSTRINGLEN];
    333  1.1  thorpej 	u_int8_t *cdata, *data;
    334  1.1  thorpej 	u_int8_t *cdp, *dp;
    335  1.1  thorpej 	struct ecu_func *ecuf;
    336  1.1  thorpej 	int i, func;
    337  1.1  thorpej 
    338  1.1  thorpej 	/*
    339  1.1  thorpej 	 * Locate EISA configuration space.
    340  1.1  thorpej 	 */
    341  1.1  thorpej 	if (hwrpb->rpb_condat_off == 0UL ||
    342  1.1  thorpej 	    (hwrpb->rpb_condat_off >> 63) != 0) {
    343  1.1  thorpej 		printf(": WARNING: no EISA configuration space");
    344  1.1  thorpej 		return;
    345  1.1  thorpej 	}
    346  1.1  thorpej 
    347  1.1  thorpej 	if (eisa_config_header_addr) {
    348  1.1  thorpej 		printf("\n");
    349  1.1  thorpej 		panic("eisa_init: EISA config space already initialized");
    350  1.1  thorpej 	}
    351  1.1  thorpej 
    352  1.1  thorpej 	eisa_config_header_addr = hwrpb->rpb_condat_off;
    353  1.6  tsutsui 	if (eisa_config_stride == 0)
    354  1.6  tsutsui 		eisa_config_stride = 1;
    355  1.6  tsutsui 
    356  1.6  tsutsui #ifdef EISA_DEBUG
    357  1.1  thorpej 	printf("\nEISA config header at 0x%lx\n", eisa_config_header_addr);
    358  1.6  tsutsui 	printf("EISA config at 0x%lx\n", eisa_config_addr);
    359  1.6  tsutsui 	printf("EISA config stride: %ld\n", eisa_config_stride);
    360  1.1  thorpej #endif
    361  1.1  thorpej 
    362  1.1  thorpej 	/*
    363  1.1  thorpej 	 * Read the slot headers, and allocate config structures for
    364  1.1  thorpej 	 * valid slots.
    365  1.1  thorpej 	 */
    366  1.6  tsutsui 	for (cfgaddr = eisa_config_header_addr, i = 0;
    367  1.6  tsutsui 	    i < eisa_maxslots(ec); i++) {
    368  1.1  thorpej 		eisa_read_config_bytes(cfgaddr, eisaid, sizeof(eisaid));
    369  1.1  thorpej 		eisaid[EISA_IDSTRINGLEN - 1] = '\0';	/* sanity */
    370  1.1  thorpej 		cfgaddr += sizeof(eisaid) * eisa_config_stride;
    371  1.1  thorpej 		eisa_read_config_word(cfgaddr, &offset);
    372  1.1  thorpej 		cfgaddr += sizeof(offset) * eisa_config_stride;
    373  1.1  thorpej 
    374  1.6  tsutsui 		if (offset != 0 && offset != 0xffffffff) {
    375  1.6  tsutsui #ifdef EISA_DEBUG
    376  1.1  thorpej 			printf("SLOT %d: offset 0x%08x eisaid %s\n",
    377  1.1  thorpej 			    i, offset, eisaid);
    378  1.1  thorpej #endif
    379  1.6  tsutsui 			ecud = malloc(sizeof(*ecud), M_DEVBUF, M_ZERO|M_WAITOK);
    380  1.6  tsutsui 			if (ecud == NULL)
    381  1.6  tsutsui 				panic("%s: can't allocate memory for ecud",
    382  1.6  tsutsui 				    __func__);
    383  1.1  thorpej 
    384  1.1  thorpej 			SIMPLEQ_INIT(&ecud->ecud_funcs);
    385  1.1  thorpej 
    386  1.1  thorpej 			ecud->ecud_slot = i;
    387  1.1  thorpej 			memcpy(ecud->ecud_eisaid, eisaid, sizeof(eisaid));
    388  1.1  thorpej 			ecud->ecud_offset = offset;
    389  1.1  thorpej 			SIMPLEQ_INSERT_TAIL(&ecu_data_list, ecud, ecud_list);
    390  1.1  thorpej 		}
    391  1.1  thorpej 	}
    392  1.1  thorpej 
    393  1.1  thorpej 	/*
    394  1.1  thorpej 	 * Now traverse the valid slots and read the info.
    395  1.1  thorpej 	 */
    396  1.1  thorpej 
    397  1.6  tsutsui 	cdata = malloc(CBUFSIZE, M_TEMP, M_ZERO|M_WAITOK);
    398  1.6  tsutsui 	if (cdata == NULL)
    399  1.6  tsutsui 		panic("%s: can't allocate memory for cdata", __func__);
    400  1.6  tsutsui 	data = malloc(CBUFSIZE, M_TEMP, M_ZERO|M_WAITOK);
    401  1.6  tsutsui 	if (data == NULL)
    402  1.6  tsutsui 		panic("%s: can't allocate memory for data", __func__);
    403  1.1  thorpej 
    404  1.5    lukem 	SIMPLEQ_FOREACH(ecud, &ecu_data_list, ecud_list) {
    405  1.1  thorpej 		cfgaddr = eisa_config_addr + ecud->ecud_offset;
    406  1.6  tsutsui #ifdef EISA_DEBUG
    407  1.6  tsutsui 		printf("Checking SLOT %d\n", ecud->ecud_slot);
    408  1.6  tsutsui 		printf("Reading config bytes at 0x%lx to cdata[0]\n", cfgaddr);
    409  1.6  tsutsui #endif
    410  1.1  thorpej 		eisa_read_config_bytes(cfgaddr, &cdata[0], 1);
    411  1.1  thorpej 		cfgaddr += eisa_config_stride;
    412  1.1  thorpej 
    413  1.6  tsutsui 		for (i = 1; i < CBUFSIZE; cfgaddr += eisa_config_stride, i++) {
    414  1.6  tsutsui #ifdef EISA_DEBUG
    415  1.6  tsutsui 			printf("Reading config bytes at 0x%lx to cdata[%d]\n",
    416  1.6  tsutsui 			    cfgaddr, i);
    417  1.6  tsutsui #endif
    418  1.1  thorpej 			eisa_read_config_bytes(cfgaddr, &cdata[i], 1);
    419  1.1  thorpej 			if (cdata[i - 1] == 0 && cdata[i] == 0)
    420  1.1  thorpej 				break;
    421  1.1  thorpej 		}
    422  1.6  tsutsui 		if (i == CBUFSIZE) {
    423  1.6  tsutsui 			/* assume this compressed data invalid */
    424  1.6  tsutsui #ifdef EISA_DEBUG
    425  1.6  tsutsui 			printf("SLOT %d has invalid config\n", ecud->ecud_slot);
    426  1.6  tsutsui #endif
    427  1.6  tsutsui 			continue;
    428  1.6  tsutsui 		}
    429  1.6  tsutsui 
    430  1.1  thorpej 		i++;	/* index -> length */
    431  1.1  thorpej 
    432  1.6  tsutsui #ifdef EISA_DEBUG
    433  1.1  thorpej 		printf("SLOT %d compressed data length %d:",
    434  1.1  thorpej 		    ecud->ecud_slot, i);
    435  1.1  thorpej 		{
    436  1.1  thorpej 			int j;
    437  1.1  thorpej 
    438  1.1  thorpej 			for (j = 0; j < i; j++) {
    439  1.1  thorpej 				if ((j % 16) == 0)
    440  1.1  thorpej 					printf("\n");
    441  1.1  thorpej 				printf("0x%02x ", cdata[j]);
    442  1.1  thorpej 			}
    443  1.1  thorpej 			printf("\n");
    444  1.1  thorpej 		}
    445  1.1  thorpej #endif
    446  1.1  thorpej 
    447  1.1  thorpej 		cdp = cdata;
    448  1.1  thorpej 		dp = data;
    449  1.1  thorpej 
    450  1.1  thorpej 		/* Uncompress the slot header. */
    451  1.1  thorpej 		cdp += eisa_uncompress(cdp, dp, EISA_SLOT_HEADER_SIZE);
    452  1.6  tsutsui #ifdef EISA_DEBUG
    453  1.1  thorpej 		printf("SLOT %d uncompressed header data:",
    454  1.1  thorpej 		    ecud->ecud_slot);
    455  1.1  thorpej 		{
    456  1.1  thorpej 			int j;
    457  1.1  thorpej 
    458  1.1  thorpej 			for (j = 0; j < EISA_SLOT_HEADER_SIZE; j++) {
    459  1.1  thorpej 				if ((j % 16) == 0)
    460  1.1  thorpej 					printf("\n");
    461  1.1  thorpej 				printf("0x%02x ", dp[j]);
    462  1.1  thorpej 			}
    463  1.1  thorpej 			printf("\n");
    464  1.1  thorpej 		}
    465  1.1  thorpej #endif
    466  1.1  thorpej 
    467  1.1  thorpej 		dp = &data[EISA_SLOT_INFO_OFFSET];
    468  1.1  thorpej 		ecud->ecud_slot_info = *dp++;
    469  1.1  thorpej 		ecud->ecud_ecu_major_rev = *dp++;
    470  1.1  thorpej 		ecud->ecud_ecu_minor_rev = *dp++;
    471  1.1  thorpej 		memcpy(&ecud->ecud_cksum, dp, sizeof(ecud->ecud_cksum));
    472  1.1  thorpej 		dp += sizeof(ecud->ecud_cksum);
    473  1.1  thorpej 		ecud->ecud_ndevfuncs = *dp++;
    474  1.1  thorpej 		ecud->ecud_funcinfo = *dp++;
    475  1.1  thorpej 		memcpy(&ecud->ecud_comp_id, dp, sizeof(ecud->ecud_comp_id));
    476  1.1  thorpej 		dp += sizeof(ecud->ecud_comp_id);
    477  1.1  thorpej 
    478  1.6  tsutsui #ifdef EISA_DEBUG
    479  1.1  thorpej 		printf("SLOT %d: ndevfuncs %d\n", ecud->ecud_slot,
    480  1.1  thorpej 		    ecud->ecud_ndevfuncs);
    481  1.1  thorpej #endif
    482  1.1  thorpej 
    483  1.1  thorpej 		for (func = 0; func < ecud->ecud_ndevfuncs; func++) {
    484  1.1  thorpej 			dp = data;
    485  1.1  thorpej 			cdp += eisa_uncompress(cdp, dp, EISA_CONFIG_BLOCK_SIZE);
    486  1.6  tsutsui #ifdef EISA_DEBUG
    487  1.1  thorpej 			printf("SLOT %d:%d uncompressed data:",
    488  1.1  thorpej 			    ecud->ecud_slot, func);
    489  1.1  thorpej 			{
    490  1.1  thorpej 				int j;
    491  1.1  thorpej 
    492  1.1  thorpej 				for (j = 0; i < EISA_CONFIG_BLOCK_SIZE; j++) {
    493  1.1  thorpej 					if ((j % 16) == 0)
    494  1.1  thorpej 						printf("\n");
    495  1.1  thorpej 					printf("0x%02x ", dp[j]);
    496  1.1  thorpej 				}
    497  1.1  thorpej 				printf("\n");
    498  1.1  thorpej 			}
    499  1.1  thorpej #endif
    500  1.1  thorpej 
    501  1.1  thorpej 			/* Skip disabled functions. */
    502  1.1  thorpej 			if (dp[EISA_FUNC_INFO_OFFSET] & ECUF_DISABLED) {
    503  1.6  tsutsui #ifdef EISA_DEBUG
    504  1.1  thorpej 				printf("SLOT %d:%d disabled\n",
    505  1.1  thorpej 				    ecud->ecud_slot, func);
    506  1.4  thorpej #endif
    507  1.1  thorpej 				continue;
    508  1.1  thorpej 			}
    509  1.1  thorpej 
    510  1.1  thorpej 			ecuf = malloc(sizeof(*ecuf), M_DEVBUF, M_WAITOK);
    511  1.6  tsutsui 			if (ecuf == NULL)
    512  1.6  tsutsui 				panic("%s: can't allocate memory for ecuf",
    513  1.6  tsutsui 				    __func__);
    514  1.1  thorpej 			ecuf_init(ecuf);
    515  1.1  thorpej 			ecuf->ecuf_funcno = func;
    516  1.1  thorpej 			SIMPLEQ_INSERT_TAIL(&ecud->ecud_funcs, ecuf,
    517  1.1  thorpej 			    ecuf_list);
    518  1.1  thorpej 
    519  1.1  thorpej 			memcpy(&ecuf->ecuf_id, dp, sizeof(ecuf->ecuf_id));
    520  1.1  thorpej 			dp += sizeof(ecuf->ecuf_id);
    521  1.1  thorpej 
    522  1.1  thorpej 			memcpy(&ecuf->ecuf_slot_info, dp,
    523  1.1  thorpej 			    sizeof(ecuf->ecuf_slot_info));
    524  1.1  thorpej 			dp += sizeof(ecuf->ecuf_slot_info);
    525  1.1  thorpej 
    526  1.1  thorpej 			memcpy(&ecuf->ecuf_cfg_ext, dp,
    527  1.1  thorpej 			    sizeof(ecuf->ecuf_cfg_ext));
    528  1.1  thorpej 			dp += sizeof(ecuf->ecuf_cfg_ext);
    529  1.1  thorpej 
    530  1.1  thorpej 			memcpy(&ecuf->ecuf_selections, dp,
    531  1.1  thorpej 			    sizeof(ecuf->ecuf_selections));
    532  1.1  thorpej 			dp += sizeof(ecuf->ecuf_selections);
    533  1.1  thorpej 
    534  1.1  thorpej 			memcpy(&ecuf->ecuf_func_info, dp,
    535  1.1  thorpej 			    sizeof(ecuf->ecuf_func_info));
    536  1.1  thorpej 			dp += sizeof(ecuf->ecuf_func_info);
    537  1.1  thorpej 
    538  1.1  thorpej 			if (ecuf->ecuf_func_info & ECUF_TYPE_STRING)
    539  1.1  thorpej 				memcpy(ecuf->ecuf_type_string, dp,
    540  1.1  thorpej 				    sizeof(ecuf->ecuf_type_string));
    541  1.1  thorpej 			dp += sizeof(ecuf->ecuf_type_string);
    542  1.1  thorpej 
    543  1.1  thorpej 			if (ecuf->ecuf_func_info & ECUF_MEM_ENTRY)
    544  1.1  thorpej 				eisa_parse_mem(ecuf, dp);
    545  1.1  thorpej 			dp += ECUF_MEM_ENTRY_SIZE * ECUF_MEM_ENTRY_CNT;
    546  1.1  thorpej 
    547  1.1  thorpej 			if (ecuf->ecuf_func_info & ECUF_IRQ_ENTRY)
    548  1.1  thorpej 				eisa_parse_irq(ecuf, dp);
    549  1.1  thorpej 			dp += ECUF_IRQ_ENTRY_SIZE * ECUF_IRQ_ENTRY_CNT;
    550  1.1  thorpej 
    551  1.1  thorpej 			if (ecuf->ecuf_func_info & ECUF_DMA_ENTRY)
    552  1.1  thorpej 				eisa_parse_dma(ecuf, dp);
    553  1.1  thorpej 			dp += ECUF_DMA_ENTRY_SIZE * ECUF_DMA_ENTRY_CNT;
    554  1.1  thorpej 
    555  1.1  thorpej 			if (ecuf->ecuf_func_info & ECUF_IO_ENTRY)
    556  1.1  thorpej 				eisa_parse_io(ecuf, dp);
    557  1.1  thorpej 			dp += ECUF_IO_ENTRY_SIZE * ECUF_IO_ENTRY_CNT;
    558  1.1  thorpej 
    559  1.1  thorpej 			if (ecuf->ecuf_func_info & ECUF_INIT_ENTRY)
    560  1.1  thorpej 				memcpy(ecuf->ecuf_init, dp,
    561  1.1  thorpej 				    sizeof(ecuf->ecuf_init));
    562  1.1  thorpej 			dp += sizeof(ecuf->ecuf_init);
    563  1.1  thorpej 		}
    564  1.1  thorpej 	}
    565  1.1  thorpej 
    566  1.1  thorpej 	free(cdata, M_TEMP);
    567  1.1  thorpej 	free(data, M_TEMP);
    568  1.3  thorpej }
    569  1.3  thorpej 
    570  1.3  thorpej static struct ecu_data *
    571  1.3  thorpej eisa_lookup_data(int slot)
    572  1.3  thorpej {
    573  1.3  thorpej 	struct ecu_data *ecud;
    574  1.3  thorpej 
    575  1.5    lukem 	SIMPLEQ_FOREACH(ecud, &ecu_data_list, ecud_list) {
    576  1.3  thorpej 		if (ecud->ecud_slot == slot)
    577  1.3  thorpej 			return (ecud);
    578  1.3  thorpej 	}
    579  1.3  thorpej 	return (NULL);
    580  1.3  thorpej }
    581  1.3  thorpej 
    582  1.3  thorpej static struct ecu_func *
    583  1.3  thorpej eisa_lookup_func(int slot, int func)
    584  1.3  thorpej {
    585  1.3  thorpej 	struct ecu_data *ecud;
    586  1.3  thorpej 	struct ecu_func *ecuf;
    587  1.3  thorpej 
    588  1.3  thorpej 	ecud = eisa_lookup_data(slot);
    589  1.3  thorpej 	if (ecud == NULL)
    590  1.3  thorpej 		return (NULL);
    591  1.3  thorpej 
    592  1.5    lukem 	SIMPLEQ_FOREACH(ecuf, &ecud->ecud_funcs, ecuf_list) {
    593  1.3  thorpej 		if (ecuf->ecuf_funcno == func)
    594  1.3  thorpej 			return (ecuf);
    595  1.3  thorpej 	}
    596  1.3  thorpej 	return (NULL);
    597  1.3  thorpej }
    598  1.3  thorpej 
    599  1.3  thorpej int
    600  1.3  thorpej eisa_conf_read_mem(eisa_chipset_tag_t ec, int slot, int func, int entry,
    601  1.3  thorpej     struct eisa_cfg_mem *dp)
    602  1.3  thorpej {
    603  1.3  thorpej 	struct ecu_func *ecuf;
    604  1.3  thorpej 	struct ecu_mem *ecum;
    605  1.3  thorpej 
    606  1.3  thorpej 	ecuf = eisa_lookup_func(slot, func);
    607  1.3  thorpej 	if (ecuf == NULL)
    608  1.3  thorpej 		return (ENOENT);
    609  1.3  thorpej 
    610  1.5    lukem 	SIMPLEQ_FOREACH(ecum, &ecuf->ecuf_mem, ecum_list) {
    611  1.3  thorpej 		if (entry-- == 0)
    612  1.3  thorpej 			break;
    613  1.3  thorpej 	}
    614  1.3  thorpej 	if (ecum == NULL)
    615  1.3  thorpej 		return (ENOENT);
    616  1.3  thorpej 
    617  1.3  thorpej 	*dp = ecum->ecum_mem;
    618  1.3  thorpej 	return (0);
    619  1.3  thorpej }
    620  1.3  thorpej 
    621  1.3  thorpej int
    622  1.3  thorpej eisa_conf_read_irq(eisa_chipset_tag_t ec, int slot, int func, int entry,
    623  1.3  thorpej     struct eisa_cfg_irq *dp)
    624  1.3  thorpej {
    625  1.3  thorpej 	struct ecu_func *ecuf;
    626  1.3  thorpej 	struct ecu_irq *ecui;
    627  1.3  thorpej 
    628  1.3  thorpej 	ecuf = eisa_lookup_func(slot, func);
    629  1.3  thorpej 	if (ecuf == NULL)
    630  1.3  thorpej 		return (ENOENT);
    631  1.3  thorpej 
    632  1.5    lukem 	SIMPLEQ_FOREACH(ecui, &ecuf->ecuf_irq, ecui_list) {
    633  1.3  thorpej 		if (entry-- == 0)
    634  1.3  thorpej 			break;
    635  1.3  thorpej 	}
    636  1.3  thorpej 	if (ecui == NULL)
    637  1.3  thorpej 		return (ENOENT);
    638  1.3  thorpej 
    639  1.3  thorpej 	*dp = ecui->ecui_irq;
    640  1.3  thorpej 	return (0);
    641  1.3  thorpej }
    642  1.3  thorpej 
    643  1.3  thorpej int
    644  1.3  thorpej eisa_conf_read_dma(eisa_chipset_tag_t ec, int slot, int func, int entry,
    645  1.3  thorpej     struct eisa_cfg_dma *dp)
    646  1.3  thorpej {
    647  1.3  thorpej 	struct ecu_func *ecuf;
    648  1.3  thorpej 	struct ecu_dma *ecud;
    649  1.3  thorpej 
    650  1.3  thorpej 	ecuf = eisa_lookup_func(slot, func);
    651  1.3  thorpej 	if (ecuf == NULL)
    652  1.3  thorpej 		return (ENOENT);
    653  1.3  thorpej 
    654  1.5    lukem 	SIMPLEQ_FOREACH(ecud, &ecuf->ecuf_dma, ecud_list) {
    655  1.3  thorpej 		if (entry-- == 0)
    656  1.3  thorpej 			break;
    657  1.3  thorpej 	}
    658  1.3  thorpej 	if (ecud == NULL)
    659  1.3  thorpej 		return (ENOENT);
    660  1.3  thorpej 
    661  1.3  thorpej 	*dp = ecud->ecud_dma;
    662  1.3  thorpej 	return (0);
    663  1.3  thorpej }
    664  1.3  thorpej 
    665  1.3  thorpej int
    666  1.3  thorpej eisa_conf_read_io(eisa_chipset_tag_t ec, int slot, int func, int entry,
    667  1.3  thorpej     struct eisa_cfg_io *dp)
    668  1.3  thorpej {
    669  1.3  thorpej 	struct ecu_func *ecuf;
    670  1.3  thorpej 	struct ecu_io *ecuio;
    671  1.3  thorpej 
    672  1.3  thorpej 	ecuf = eisa_lookup_func(slot, func);
    673  1.3  thorpej 	if (ecuf == NULL)
    674  1.3  thorpej 		return (ENOENT);
    675  1.3  thorpej 
    676  1.5    lukem 	SIMPLEQ_FOREACH(ecuio, &ecuf->ecuf_io, ecuio_list) {
    677  1.3  thorpej 		if (entry-- == 0)
    678  1.3  thorpej 			break;
    679  1.3  thorpej 	}
    680  1.3  thorpej 	if (ecuio == NULL)
    681  1.3  thorpej 		return (ENOENT);
    682  1.3  thorpej 
    683  1.3  thorpej 	*dp = ecuio->ecuio_io;
    684  1.3  thorpej 	return (0);
    685  1.1  thorpej }
    686