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