Home | History | Annotate | Line # | Download | only in isapnp
isapnp.c revision 1.4.2.1
      1  1.4.2.1   thorpej /*	$NetBSD: isapnp.c,v 1.4.2.1 1997/05/13 03:45:46 thorpej Exp $	*/
      2      1.1  christos 
      3      1.1  christos /*
      4      1.1  christos  * Copyright (c) 1996 Christos Zoulas.  All rights reserved.
      5      1.1  christos  *
      6      1.1  christos  * Redistribution and use in source and binary forms, with or without
      7      1.1  christos  * modification, are permitted provided that the following conditions
      8      1.1  christos  * are met:
      9      1.1  christos  * 1. Redistributions of source code must retain the above copyright
     10      1.1  christos  *    notice, this list of conditions and the following disclaimer.
     11      1.1  christos  * 2. Redistributions in binary form must reproduce the above copyright
     12      1.1  christos  *    notice, this list of conditions and the following disclaimer in the
     13      1.1  christos  *    documentation and/or other materials provided with the distribution.
     14      1.1  christos  * 3. All advertising materials mentioning features or use of this software
     15      1.1  christos  *    must display the following acknowledgement:
     16      1.1  christos  *	This product includes software developed by Christos Zoulas.
     17      1.1  christos  * 4. The name of the author may not be used to endorse or promote products
     18      1.1  christos  *    derived from this software without specific prior written permission.
     19      1.1  christos  *
     20      1.1  christos  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     21      1.1  christos  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     22      1.1  christos  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     23      1.1  christos  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     24      1.1  christos  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     25      1.1  christos  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     26      1.1  christos  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     27      1.1  christos  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     28      1.1  christos  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     29      1.1  christos  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     30      1.1  christos  */
     31      1.1  christos 
     32      1.1  christos /*
     33      1.1  christos  * ISA PnP bus autoconfiguration.
     34      1.1  christos  */
     35      1.1  christos 
     36      1.1  christos #include <sys/param.h>
     37      1.1  christos #include <sys/systm.h>
     38      1.1  christos #include <sys/device.h>
     39      1.1  christos #include <sys/malloc.h>
     40      1.1  christos 
     41      1.1  christos #include <machine/bus.h>
     42      1.1  christos 
     43      1.1  christos #include <dev/isa/isavar.h>
     44      1.1  christos 
     45      1.1  christos #include <dev/isapnp/isapnpreg.h>
     46      1.1  christos #include <dev/isapnp/isapnpvar.h>
     47      1.1  christos 
     48      1.1  christos static void isapnp_init __P((struct isapnp_softc *));
     49      1.1  christos static __inline u_char isapnp_shift_bit __P((struct isapnp_softc *));
     50      1.1  christos static int isapnp_findcard __P((struct isapnp_softc *));
     51      1.1  christos static void isapnp_free_region __P((bus_space_tag_t, struct isapnp_region *));
     52      1.1  christos static int isapnp_alloc_region __P((bus_space_tag_t, struct isapnp_region *));
     53      1.1  christos static int isapnp_alloc_pin __P((struct isapnp_pin *));
     54      1.1  christos static int isapnp_testconfig __P((bus_space_tag_t, bus_space_tag_t,
     55      1.1  christos     struct isapnp_attach_args *, int));
     56      1.1  christos static struct isapnp_attach_args *isapnp_bestconfig __P((struct isapnp_softc *,
     57      1.1  christos     struct isapnp_attach_args **));
     58      1.1  christos static void isapnp_print_region __P((const char *, struct isapnp_region *,
     59      1.1  christos     size_t));
     60      1.1  christos static void isapnp_configure __P((struct isapnp_softc *,
     61      1.1  christos     const struct isapnp_attach_args *));
     62      1.1  christos static void isapnp_print_pin __P((const char *, struct isapnp_pin *, size_t));
     63      1.1  christos static int isapnp_print __P((void *, const char *));
     64      1.1  christos static int isapnp_submatch __P((struct device *, void *, void *));
     65      1.1  christos static int isapnp_find __P((struct isapnp_softc *));
     66      1.1  christos static int isapnp_match __P((struct device *, void *, void *));
     67      1.1  christos static void isapnp_attach __P((struct device *, struct device *, void *));
     68      1.1  christos 
     69      1.1  christos struct cfattach isapnp_ca = {
     70      1.1  christos 	sizeof(struct isapnp_softc), isapnp_match, isapnp_attach
     71      1.1  christos };
     72      1.1  christos 
     73      1.1  christos struct cfdriver isapnp_cd = {
     74      1.1  christos 	NULL, "isapnp", DV_DULL
     75      1.1  christos };
     76      1.1  christos 
     77      1.1  christos 
     78      1.1  christos /* isapnp_init():
     79      1.1  christos  *	Write the PNP initiation key to wake up the cards...
     80      1.1  christos  */
     81      1.1  christos static void
     82      1.1  christos isapnp_init(sc)
     83      1.1  christos 	struct isapnp_softc *sc;
     84      1.1  christos {
     85      1.1  christos 	int i;
     86      1.1  christos 	u_char v = ISAPNP_LFSR_INIT;
     87      1.1  christos 
     88      1.1  christos 	/* First write 0's twice to enter the Wait for Key state */
     89      1.1  christos 	ISAPNP_WRITE_ADDR(sc, 0);
     90      1.1  christos 	ISAPNP_WRITE_ADDR(sc, 0);
     91      1.1  christos 
     92      1.1  christos 	/* Send the 32 byte sequence to awake the logic */
     93      1.1  christos 	for (i = 0; i < 32; i++) {
     94      1.1  christos 		ISAPNP_WRITE_ADDR(sc, v);
     95      1.1  christos 		v = ISAPNP_LFSR_NEXT(v);
     96      1.1  christos 	}
     97      1.1  christos }
     98      1.1  christos 
     99      1.1  christos 
    100      1.1  christos /* isapnp_shift_bit():
    101      1.1  christos  *	Read a bit at a time from the config card.
    102      1.1  christos  */
    103      1.1  christos static __inline u_char
    104      1.1  christos isapnp_shift_bit(sc)
    105      1.1  christos 	struct isapnp_softc *sc;
    106      1.1  christos {
    107      1.1  christos 	u_char c1, c2;
    108      1.1  christos 
    109      1.1  christos 	DELAY(250);
    110      1.1  christos 	c1 = ISAPNP_READ_DATA(sc);
    111      1.1  christos 	DELAY(250);
    112      1.1  christos 	c2 = ISAPNP_READ_DATA(sc);
    113      1.1  christos 
    114      1.1  christos 	if (c1 == 0x55 && c2 == 0xAA)
    115      1.1  christos 		return 0x80;
    116      1.1  christos 	else
    117      1.1  christos 		return 0;
    118      1.1  christos }
    119      1.1  christos 
    120      1.1  christos 
    121      1.1  christos /* isapnp_findcard():
    122      1.1  christos  *	Attempt to read the vendor/serial/checksum for a card
    123      1.1  christos  *	If a card is found [the checksum matches], assign the
    124      1.1  christos  *	next card number to it and return 1
    125      1.1  christos  */
    126      1.1  christos static int
    127      1.1  christos isapnp_findcard(sc)
    128      1.1  christos 	struct isapnp_softc *sc;
    129      1.1  christos {
    130      1.4  christos 	u_char v = ISAPNP_LFSR_INIT, csum, w;
    131      1.1  christos 	int i, b;
    132      1.1  christos 
    133      1.1  christos 	if (sc->sc_ncards == ISAPNP_MAX_CARDS) {
    134      1.1  christos 		printf("%s: Too many pnp cards\n", sc->sc_dev.dv_xname);
    135      1.1  christos 		return 0;
    136      1.1  christos 	}
    137      1.1  christos 
    138      1.1  christos 	/* Set the read port */
    139      1.1  christos 	isapnp_write_reg(sc, ISAPNP_WAKE, 0);
    140      1.1  christos 	isapnp_write_reg(sc, ISAPNP_SET_RD_PORT, sc->sc_read_port >> 2);
    141      1.1  christos 	sc->sc_read_port |= 3;
    142      1.1  christos 	DELAY(1000);
    143      1.1  christos 
    144      1.1  christos 	ISAPNP_WRITE_ADDR(sc, ISAPNP_SERIAL_ISOLATION);
    145      1.1  christos 	DELAY(1000);
    146      1.1  christos 
    147      1.1  christos 	/* Read the 8 bytes of the Vendor ID and Serial Number */
    148      1.1  christos 	for(i = 0; i < 8; i++) {
    149      1.1  christos 		/* Read each bit separately */
    150      1.1  christos 		for (w = 0, b = 0; b < 8; b++) {
    151      1.1  christos 			u_char neg = isapnp_shift_bit(sc);
    152      1.1  christos 
    153      1.1  christos 			w >>= 1;
    154      1.1  christos 			w |= neg;
    155      1.1  christos 			v = ISAPNP_LFSR_NEXT(v) ^ neg;
    156      1.1  christos 		}
    157      1.1  christos 		sc->sc_id[sc->sc_ncards][i] = w;
    158      1.1  christos 	}
    159      1.1  christos 
    160      1.1  christos 	/* Read the remaining checksum byte */
    161      1.4  christos 	for (csum = 0, b = 0; b < 8; b++) {
    162      1.1  christos 		u_char neg = isapnp_shift_bit(sc);
    163      1.1  christos 
    164      1.1  christos 		csum >>= 1;
    165      1.1  christos 		csum |= neg;
    166      1.1  christos 	}
    167      1.4  christos 	sc->sc_id[sc->sc_ncards][8] = csum;
    168      1.1  christos 
    169      1.1  christos 	if (csum == v) {
    170      1.1  christos 		sc->sc_ncards++;
    171      1.1  christos 		isapnp_write_reg(sc, ISAPNP_CARD_SELECT_NUM, sc->sc_ncards);
    172      1.1  christos 		return 1;
    173      1.1  christos 	}
    174      1.1  christos 	return 0;
    175      1.1  christos }
    176      1.1  christos 
    177      1.1  christos 
    178      1.1  christos /* isapnp_free_region():
    179      1.1  christos  *	Free a region
    180      1.1  christos  */
    181      1.1  christos static void
    182      1.1  christos isapnp_free_region(t, r)
    183      1.1  christos 	bus_space_tag_t t;
    184      1.1  christos 	struct isapnp_region *r;
    185      1.1  christos {
    186      1.1  christos 	bus_space_unmap(t, r->h, r->length);
    187      1.1  christos }
    188      1.1  christos 
    189      1.1  christos 
    190      1.1  christos /* isapnp_alloc_region():
    191      1.1  christos  *	Allocate a single region if possible
    192      1.1  christos  */
    193      1.1  christos static int
    194      1.1  christos isapnp_alloc_region(t, r)
    195      1.1  christos 	bus_space_tag_t t;
    196      1.1  christos 	struct isapnp_region *r;
    197      1.1  christos {
    198      1.1  christos 	int error = 0;
    199      1.1  christos 
    200      1.1  christos 	for (r->base = r->minbase; r->base <= r->maxbase; r->base += r->align) {
    201      1.1  christos 		error = bus_space_map(t, r->base, r->length, 0, &r->h);
    202      1.1  christos 		if (error == 0)
    203      1.1  christos 			return 0;
    204      1.1  christos 	}
    205      1.1  christos 	return error;
    206      1.1  christos }
    207      1.1  christos 
    208      1.1  christos 
    209      1.1  christos /* isapnp_alloc_pin():
    210      1.1  christos  *	Allocate an irq/drq
    211      1.1  christos  *	XXX: No resource conflict checks!
    212      1.1  christos  */
    213      1.1  christos static int
    214      1.1  christos isapnp_alloc_pin(i)
    215      1.1  christos 	struct isapnp_pin *i;
    216      1.1  christos {
    217      1.1  christos 	int b;
    218      1.1  christos 
    219      1.1  christos 	if (i->bits == 0)
    220      1.1  christos 		i->num = 0;
    221      1.1  christos 	else
    222      1.1  christos 		for (b = 0; b < 16; b++)
    223      1.3  christos 			if (i->bits & (1 << b)) {
    224      1.1  christos 				i->num = b;
    225      1.3  christos 				break;
    226      1.3  christos 			}
    227      1.1  christos 	return 0;
    228      1.1  christos }
    229      1.1  christos 
    230      1.1  christos 
    231      1.1  christos /* isapnp_testconfig():
    232      1.1  christos  *	Test/Allocate the regions used
    233      1.1  christos  */
    234      1.1  christos static int
    235      1.1  christos isapnp_testconfig(iot, memt, ipa, alloc)
    236      1.1  christos 	bus_space_tag_t iot, memt;
    237      1.1  christos 	struct isapnp_attach_args *ipa;
    238      1.1  christos 	int alloc;
    239      1.1  christos {
    240      1.1  christos 	int nio = 0, nmem = 0, nmem32 = 0, nirq = 0, ndrq = 0;
    241      1.1  christos 	int error = 0;
    242      1.1  christos 
    243      1.1  christos #ifdef DEBUG_ISAPNP
    244      1.1  christos 	isapnp_print_attach(ipa);
    245      1.1  christos #endif
    246      1.1  christos 
    247      1.1  christos 	for (; nio < ipa->ipa_nio; nio++) {
    248      1.1  christos 		error = isapnp_alloc_region(iot, &ipa->ipa_io[nio]);
    249      1.1  christos 		if (error)
    250      1.1  christos 			goto bad;
    251      1.1  christos 	}
    252      1.1  christos 
    253      1.1  christos 	for (; nmem < ipa->ipa_nmem; nmem++) {
    254      1.1  christos 		error = isapnp_alloc_region(memt, &ipa->ipa_mem[nmem]);
    255      1.1  christos 		if (error)
    256      1.1  christos 			goto bad;
    257      1.1  christos 	}
    258      1.1  christos 
    259      1.1  christos 	for (; nmem32 < ipa->ipa_nmem32; nmem32++) {
    260      1.1  christos 		error = isapnp_alloc_region(memt, &ipa->ipa_mem32[nmem32]);
    261      1.1  christos 		if (error)
    262      1.1  christos 			goto bad;
    263      1.1  christos 	}
    264      1.1  christos 
    265      1.1  christos 	for (; nirq < ipa->ipa_nirq; nirq++) {
    266      1.1  christos 		error = isapnp_alloc_pin(&ipa->ipa_irq[nirq]);
    267      1.1  christos 		if (error)
    268      1.1  christos 			goto bad;
    269      1.1  christos 	}
    270      1.1  christos 
    271      1.1  christos 	for (; ndrq < ipa->ipa_ndrq; ndrq++) {
    272      1.1  christos 		error = isapnp_alloc_pin(&ipa->ipa_drq[ndrq]);
    273      1.1  christos 		if (error)
    274      1.1  christos 			goto bad;
    275      1.1  christos 	}
    276      1.1  christos 
    277      1.1  christos 	if (alloc)
    278      1.1  christos 		return error;
    279      1.1  christos 
    280      1.1  christos bad:
    281      1.1  christos #ifdef notyet
    282      1.1  christos 	for (ndrq--; ndrq >= 0; ndrq--)
    283      1.1  christos 		isapnp_free_pin(&ipa->ipa_drq[ndrq]);
    284      1.1  christos 
    285      1.1  christos 	for (nirq--; nirq >= 0; nirq--)
    286      1.1  christos 		isapnp_free_pin(&ipa->ipa_irq[nirq]);
    287      1.1  christos #endif
    288      1.1  christos 
    289      1.1  christos 	for (nmem32--; nmem32 >= 0; nmem32--)
    290      1.1  christos 		isapnp_free_region(memt, &ipa->ipa_mem32[nmem32]);
    291      1.1  christos 
    292      1.1  christos 	for (nmem--; nmem >= 0; nmem--)
    293      1.1  christos 		isapnp_free_region(memt, &ipa->ipa_mem[nmem]);
    294      1.1  christos 
    295      1.1  christos 	for (nio--; nio >= 0; nio--)
    296      1.1  christos 		isapnp_free_region(iot, &ipa->ipa_io[nio]);
    297      1.1  christos 
    298      1.1  christos 	return error;
    299      1.1  christos }
    300      1.1  christos 
    301      1.1  christos 
    302      1.1  christos /* isapnp_config():
    303      1.1  christos  *	Test/Allocate the regions used
    304      1.1  christos  */
    305      1.1  christos int
    306      1.1  christos isapnp_config(iot, memt, ipa)
    307      1.1  christos 	bus_space_tag_t iot, memt;
    308      1.1  christos 	struct isapnp_attach_args *ipa;
    309      1.1  christos {
    310      1.1  christos 	return isapnp_testconfig(iot, memt, ipa, 1);
    311      1.1  christos }
    312      1.1  christos 
    313      1.1  christos 
    314      1.1  christos /* isapnp_unconfig():
    315      1.1  christos  *	Free the regions used
    316      1.1  christos  */
    317      1.1  christos void
    318      1.1  christos isapnp_unconfig(iot, memt, ipa)
    319      1.1  christos 	bus_space_tag_t iot, memt;
    320      1.1  christos 	struct isapnp_attach_args *ipa;
    321      1.1  christos {
    322      1.1  christos 	int i;
    323      1.1  christos 
    324      1.1  christos #ifdef notyet
    325      1.1  christos 	for (i = 0; i < ipa->ipa_ndrq; i++)
    326      1.1  christos 		isapnp_free_pin(&ipa->ipa_drq[i]);
    327      1.1  christos 
    328      1.1  christos 	for (i = 0; i < ipa->ipa_nirq; i++)
    329      1.1  christos 		isapnp_free_pin(&ipa->ipa_irq[i]);
    330      1.1  christos #endif
    331      1.1  christos 
    332      1.1  christos 	for (i = 0; i < ipa->ipa_nmem32; i++)
    333      1.1  christos 		isapnp_free_region(memt, &ipa->ipa_mem32[i]);
    334      1.1  christos 
    335      1.1  christos 	for (i = 0; i < ipa->ipa_nmem; i++)
    336      1.1  christos 		isapnp_free_region(memt, &ipa->ipa_mem[i]);
    337      1.1  christos 
    338      1.1  christos 	for (i = 0; i < ipa->ipa_nio; i++)
    339      1.1  christos 		isapnp_free_region(iot, &ipa->ipa_io[i]);
    340      1.1  christos }
    341      1.1  christos 
    342      1.1  christos 
    343      1.1  christos /* isapnp_bestconfig():
    344      1.1  christos  *	Return the best configuration for each logical device, remove and
    345      1.1  christos  *	free all other configurations.
    346      1.1  christos  */
    347      1.1  christos static struct isapnp_attach_args *
    348      1.1  christos isapnp_bestconfig(sc, ipa)
    349      1.1  christos 	struct isapnp_softc *sc;
    350      1.1  christos 	struct isapnp_attach_args **ipa;
    351      1.1  christos {
    352      1.1  christos 	struct isapnp_attach_args *c, *best, *f = *ipa;
    353      1.1  christos 	int error;
    354      1.1  christos 
    355      1.1  christos 	for (;;) {
    356      1.1  christos 		if (f == NULL)
    357      1.1  christos 			return NULL;
    358      1.1  christos 
    359      1.1  christos #define SAMEDEV(a, b) (strcmp((a)->ipa_devlogic, (b)->ipa_devlogic) == 0)
    360      1.1  christos 
    361      1.1  christos 		/* Find the best config */
    362      1.2  christos 		for (best = c = f; c != NULL; c = c->ipa_sibling) {
    363      1.1  christos 			if (!SAMEDEV(c, f))
    364      1.1  christos 				continue;
    365      1.1  christos 			if (c->ipa_pref < best->ipa_pref)
    366      1.1  christos 				best = c;
    367      1.1  christos 		}
    368      1.1  christos 
    369      1.1  christos 		/* Test the best config */
    370      1.1  christos 		error = isapnp_testconfig(sc->sc_iot, sc->sc_memt, best, 0);
    371      1.1  christos 
    372      1.1  christos 		/* Remove this config from the list */
    373      1.1  christos 		if (best == f)
    374      1.2  christos 			f = f->ipa_sibling;
    375      1.1  christos 		else {
    376      1.2  christos 			for (c = f; c->ipa_sibling != best; c = c->ipa_sibling)
    377      1.1  christos 				continue;
    378      1.2  christos 			c->ipa_sibling = best->ipa_sibling;
    379      1.1  christos 		}
    380      1.1  christos 
    381      1.1  christos 		if (error) {
    382      1.1  christos 			best->ipa_pref = ISAPNP_DEP_CONFLICTING;
    383      1.1  christos 
    384      1.2  christos 			for (c = f; c != NULL; c = c->ipa_sibling)
    385      1.1  christos 				if (c != best && SAMEDEV(c, best))
    386      1.1  christos 					break;
    387      1.1  christos 			/* Last config for this logical device is conflicting */
    388      1.1  christos 			if (c == NULL) {
    389      1.1  christos 				*ipa = f;
    390      1.1  christos 				return best;
    391      1.1  christos 			}
    392      1.1  christos 
    393      1.1  christos 			ISAPNP_FREE(best);
    394      1.1  christos 			continue;
    395      1.1  christos 		}
    396      1.1  christos 		else {
    397      1.1  christos 			/* Remove all other configs for this device */
    398      1.1  christos 			struct isapnp_attach_args *l = NULL, *n = NULL, *d;
    399      1.1  christos 
    400      1.1  christos 			for (c = f; c; ) {
    401      1.1  christos 				if (c == best)
    402      1.1  christos 					continue;
    403      1.2  christos 				d = c->ipa_sibling;
    404      1.1  christos 				if (SAMEDEV(c, best))
    405      1.1  christos 					ISAPNP_FREE(c);
    406      1.1  christos 				else {
    407      1.1  christos 					if (n)
    408      1.2  christos 						n->ipa_sibling = c;
    409      1.1  christos 
    410      1.1  christos 					else
    411      1.1  christos 						l = c;
    412      1.1  christos 					n = c;
    413      1.2  christos 					c->ipa_sibling = NULL;
    414      1.1  christos 				}
    415      1.1  christos 				c = d;
    416      1.1  christos 			}
    417      1.1  christos 			f = l;
    418      1.1  christos 		}
    419      1.1  christos 		*ipa = f;
    420      1.1  christos 		return best;
    421      1.1  christos 	}
    422      1.1  christos }
    423      1.1  christos 
    424      1.1  christos 
    425      1.1  christos /* isapnp_id_to_vendor():
    426      1.1  christos  *	Convert a pnp ``compressed ascii'' vendor id to a string
    427      1.1  christos  */
    428      1.1  christos char *
    429      1.1  christos isapnp_id_to_vendor(v, id)
    430      1.1  christos 	char   *v;
    431      1.1  christos 	const u_char *id;
    432      1.1  christos {
    433      1.1  christos 	static const char hex[] = "0123456789ABCDEF";
    434      1.1  christos 	char *p = v;
    435      1.1  christos 
    436      1.1  christos 	*p++ = 'A' + (id[0] >> 2) - 1;
    437      1.1  christos 	*p++ = 'A' + ((id[0] & 3) << 3) + (id[1] >> 5) - 1;
    438      1.1  christos 	*p++ = 'A' + (id[1] & 0x1f) - 1;
    439      1.1  christos 	*p++ = hex[id[2] >> 4];
    440      1.1  christos 	*p++ = hex[id[2] & 0x0f];
    441      1.1  christos 	*p++ = hex[id[3] >> 4];
    442      1.1  christos 	*p++ = hex[id[3] & 0x0f];
    443      1.1  christos 	*p = '\0';
    444      1.1  christos 
    445      1.1  christos 	return v;
    446      1.1  christos }
    447      1.1  christos 
    448      1.1  christos 
    449      1.1  christos /* isapnp_print_region():
    450      1.1  christos  *	Print a region allocation
    451      1.1  christos  */
    452      1.1  christos static void
    453      1.1  christos isapnp_print_region(str, r, n)
    454      1.1  christos 	const char *str;
    455      1.1  christos 	struct isapnp_region *r;
    456      1.1  christos 	size_t n;
    457      1.1  christos {
    458      1.1  christos 	size_t i;
    459      1.1  christos 
    460      1.1  christos 	if (n == 0)
    461      1.1  christos 		return;
    462      1.1  christos 
    463      1.1  christos 	printf(" %s ", str);
    464      1.1  christos 	for (i = 0; i < n; i++, r++) {
    465      1.1  christos 		printf("0x%x", r->base);
    466      1.1  christos 		if (r->length)
    467      1.1  christos 			printf("/%d", r->length);
    468      1.1  christos 		if (i != n - 1)
    469      1.1  christos 			printf(",");
    470      1.1  christos 	}
    471      1.1  christos }
    472      1.1  christos 
    473      1.1  christos 
    474      1.1  christos /* isapnp_print_pin():
    475      1.1  christos  *	Print an irq/drq assignment
    476      1.1  christos  */
    477      1.1  christos static void
    478      1.1  christos isapnp_print_pin(str, p, n)
    479      1.1  christos 	const char *str;
    480      1.1  christos 	struct isapnp_pin *p;
    481      1.1  christos 	size_t n;
    482      1.1  christos {
    483      1.1  christos 	size_t i;
    484      1.1  christos 
    485      1.1  christos 	if (n == 0)
    486      1.1  christos 		return;
    487      1.1  christos 
    488      1.1  christos 	printf(" %s ", str);
    489      1.1  christos 	for (i = 0; i < n; i++, p++) {
    490      1.1  christos 		printf("%d", p->num);
    491      1.1  christos 		if (i != n - 1)
    492      1.1  christos 			printf(",");
    493      1.1  christos 	}
    494      1.1  christos }
    495      1.1  christos 
    496      1.1  christos 
    497      1.1  christos /* isapnp_print():
    498      1.1  christos  *	Print the configuration line for an ISA PnP card.
    499      1.1  christos  */
    500      1.1  christos static int
    501      1.1  christos isapnp_print(aux, str)
    502      1.1  christos 	void *aux;
    503      1.1  christos 	const char *str;
    504      1.1  christos {
    505      1.1  christos 	struct isapnp_attach_args *ipa = aux;
    506      1.1  christos 
    507      1.1  christos 	if (str != NULL)
    508      1.1  christos 		printf("%s: <%s, %s, %s>",
    509      1.1  christos 		    str, ipa->ipa_devident, ipa->ipa_devlogic,
    510      1.1  christos 		    ipa->ipa_devclass);
    511      1.1  christos 
    512      1.1  christos 	isapnp_print_region("port", ipa->ipa_io, ipa->ipa_nio);
    513      1.1  christos 	isapnp_print_region("mem", ipa->ipa_mem, ipa->ipa_nmem);
    514      1.1  christos 	isapnp_print_region("mem32", ipa->ipa_mem32, ipa->ipa_nmem32);
    515      1.1  christos 	isapnp_print_pin("irq", ipa->ipa_irq, ipa->ipa_nirq);
    516      1.1  christos 	isapnp_print_pin("drq", ipa->ipa_drq, ipa->ipa_ndrq);
    517      1.1  christos 
    518      1.1  christos 	return UNCONF;
    519      1.1  christos }
    520      1.1  christos 
    521      1.1  christos 
    522      1.1  christos /* isapnp_submatch():
    523      1.1  christos  *	Probe the card...
    524      1.1  christos  */
    525      1.1  christos static int
    526      1.1  christos isapnp_submatch(parent, match, aux)
    527      1.1  christos 	struct device *parent;
    528      1.1  christos 	void *match, *aux;
    529      1.1  christos {
    530      1.1  christos 	struct cfdata *cf = match;
    531      1.1  christos 	return ((*cf->cf_attach->ca_match)(parent, match, aux));
    532      1.1  christos }
    533      1.1  christos 
    534      1.1  christos 
    535      1.1  christos /* isapnp_find():
    536      1.1  christos  *	Probe and add cards
    537      1.1  christos  */
    538      1.1  christos static int
    539      1.1  christos isapnp_find(sc)
    540      1.1  christos 	struct isapnp_softc *sc;
    541      1.1  christos {
    542      1.1  christos 	int p;
    543      1.1  christos 
    544      1.1  christos 	isapnp_init(sc);
    545      1.1  christos 
    546      1.1  christos 	isapnp_write_reg(sc, ISAPNP_CONFIG_CONTROL, ISAPNP_CC_RESET_DRV);
    547      1.1  christos 	DELAY(2000);
    548      1.1  christos 
    549      1.1  christos 	isapnp_init(sc);
    550      1.1  christos 	DELAY(2000);
    551      1.1  christos 
    552      1.1  christos 	for (p = ISAPNP_RDDATA_MIN; p <= ISAPNP_RDDATA_MAX; p += 4) {
    553      1.1  christos 		sc->sc_read_port = p;
    554      1.1  christos 		if (isapnp_map_readport(sc))
    555      1.1  christos 			continue;
    556      1.1  christos 		DPRINTF(("%s: Trying port %x\n", sc->sc_dev.dv_xname, p));
    557      1.1  christos 		if (isapnp_findcard(sc))
    558      1.1  christos 			break;
    559      1.1  christos 		isapnp_unmap_readport(sc);
    560      1.1  christos 	}
    561      1.1  christos 
    562      1.1  christos 	if (p > ISAPNP_RDDATA_MAX) {
    563      1.1  christos 		sc->sc_read_port = 0;
    564      1.1  christos 		return 0;
    565      1.1  christos 	}
    566      1.1  christos 
    567      1.1  christos 	while (isapnp_findcard(sc))
    568      1.1  christos 		continue;
    569      1.1  christos 
    570      1.1  christos 	return 1;
    571      1.1  christos }
    572      1.1  christos 
    573      1.1  christos 
    574      1.1  christos /* isapnp_configure():
    575      1.1  christos  *	Configure a PnP card
    576      1.1  christos  *	XXX: The memory configuration code is wrong. We need to check the
    577      1.1  christos  *	     range/length bit an do appropriate sets.
    578      1.1  christos  */
    579      1.1  christos static void
    580      1.1  christos isapnp_configure(sc, ipa)
    581      1.1  christos 	struct isapnp_softc *sc;
    582      1.1  christos 	const struct isapnp_attach_args *ipa;
    583      1.1  christos {
    584      1.1  christos 	int i;
    585      1.1  christos 	static u_char isapnp_mem_range[] = ISAPNP_MEM_DESC;
    586      1.1  christos 	static u_char isapnp_io_range[] = ISAPNP_IO_DESC;
    587      1.1  christos 	static u_char isapnp_irq_range[] = ISAPNP_IRQ_DESC;
    588      1.1  christos 	static u_char isapnp_drq_range[] = ISAPNP_DRQ_DESC;
    589      1.1  christos 	static u_char isapnp_mem32_range[] = ISAPNP_MEM32_DESC;
    590      1.1  christos 	const struct isapnp_region *r;
    591      1.1  christos 	const struct isapnp_pin *p;
    592      1.1  christos 	struct isapnp_region rz;
    593      1.1  christos 	struct isapnp_pin pz;
    594      1.1  christos 
    595      1.1  christos 	memset(&pz, 0, sizeof(pz));
    596      1.1  christos 	memset(&rz, 0, sizeof(rz));
    597      1.1  christos 
    598      1.1  christos #define B0(a) ((a) & 0xff)
    599      1.1  christos #define B1(a) (((a) >> 8) & 0xff)
    600      1.1  christos #define B2(a) (((a) >> 16) & 0xff)
    601      1.1  christos #define B3(a) (((a) >> 24) & 0xff)
    602      1.1  christos 
    603      1.1  christos 	for (i = 0; i < sizeof(isapnp_io_range); i++) {
    604      1.1  christos 		if (i < ipa->ipa_nio)
    605      1.1  christos 			r = &ipa->ipa_io[i];
    606      1.1  christos 		else
    607      1.1  christos 			r = &rz;
    608      1.1  christos 
    609      1.1  christos 		isapnp_write_reg(sc,
    610      1.1  christos 		    isapnp_io_range[i] + ISAPNP_IO_BASE_15_8, B1(r->base));
    611      1.1  christos 		isapnp_write_reg(sc,
    612      1.1  christos 		    isapnp_io_range[i] + ISAPNP_IO_BASE_7_0, B0(r->base));
    613      1.1  christos 	}
    614      1.1  christos 
    615      1.1  christos 	for (i = 0; i < sizeof(isapnp_mem_range); i++) {
    616      1.1  christos 		if (i < ipa->ipa_nmem)
    617      1.1  christos 			r = &ipa->ipa_mem[i];
    618      1.1  christos 		else
    619      1.1  christos 			r = &rz;
    620      1.1  christos 
    621      1.1  christos 		isapnp_write_reg(sc,
    622      1.1  christos 		    isapnp_mem_range[i] + ISAPNP_MEM_BASE_23_16, B2(r->base));
    623      1.1  christos 		isapnp_write_reg(sc,
    624      1.1  christos 		    isapnp_mem_range[i] + ISAPNP_MEM_BASE_15_8, B1(r->base));
    625      1.1  christos 
    626      1.1  christos 		isapnp_write_reg(sc,
    627      1.1  christos 		    isapnp_mem_range[i] + ISAPNP_MEM_LRANGE_23_16,
    628      1.1  christos 		    B2(r->length));
    629      1.1  christos 		isapnp_write_reg(sc,
    630      1.1  christos 		    isapnp_mem_range[i] + ISAPNP_MEM_LRANGE_15_8,
    631      1.1  christos 		    B1(r->length));
    632      1.1  christos 	}
    633      1.1  christos 
    634      1.1  christos 	for (i = 0; i < sizeof(isapnp_irq_range); i++) {
    635      1.1  christos 		u_char v;
    636      1.1  christos 
    637      1.1  christos 		if (i < ipa->ipa_nirq)
    638      1.1  christos 			p = &ipa->ipa_irq[i];
    639      1.1  christos 		else
    640      1.1  christos 			p = &pz;
    641      1.1  christos 
    642      1.1  christos 		isapnp_write_reg(sc,
    643      1.1  christos 		    isapnp_irq_range[i] + ISAPNP_IRQ_NUMBER, p->num);
    644      1.1  christos 
    645      1.1  christos 		switch (p->flags) {
    646      1.1  christos 		case ISAPNP_IRQTYPE_LEVEL_PLUS:
    647      1.1  christos 			v = ISAPNP_IRQ_LEVEL|ISAPNP_IRQ_HIGH;
    648      1.1  christos 			break;
    649      1.1  christos 
    650      1.1  christos 		case ISAPNP_IRQTYPE_EDGE_PLUS:
    651      1.1  christos 			v = ISAPNP_IRQ_HIGH;
    652      1.1  christos 			break;
    653      1.1  christos 
    654      1.1  christos 		case ISAPNP_IRQTYPE_LEVEL_MINUS:
    655      1.1  christos 			v = ISAPNP_IRQ_LEVEL;
    656      1.1  christos 			break;
    657      1.1  christos 
    658      1.1  christos 		default:
    659      1.1  christos 		case ISAPNP_IRQTYPE_EDGE_MINUS:
    660      1.1  christos 			v = 0;
    661      1.1  christos 			break;
    662      1.1  christos 		}
    663      1.1  christos 		isapnp_write_reg(sc,
    664      1.1  christos 		    isapnp_irq_range[i] + ISAPNP_IRQ_CONTROL, v);
    665      1.1  christos 	}
    666      1.1  christos 
    667      1.1  christos 	for (i = 0; i < sizeof(isapnp_drq_range); i++) {
    668      1.1  christos 		u_char v;
    669      1.1  christos 
    670      1.1  christos 		if (i < ipa->ipa_ndrq)
    671      1.1  christos 			v = ipa->ipa_drq[i].num;
    672      1.1  christos 		else
    673      1.1  christos 			v = 4;
    674      1.1  christos 
    675      1.1  christos 		isapnp_write_reg(sc, isapnp_drq_range[i], v);
    676      1.1  christos 	}
    677      1.1  christos 
    678      1.1  christos 	for (i = 0; i < sizeof(isapnp_mem32_range); i++) {
    679      1.1  christos 		if (i < ipa->ipa_nmem32)
    680      1.1  christos 			r = &ipa->ipa_mem32[i];
    681      1.1  christos 		else
    682      1.1  christos 			r = &rz;
    683      1.1  christos 
    684      1.1  christos 		isapnp_write_reg(sc,
    685      1.1  christos 		    isapnp_mem32_range[i] + ISAPNP_MEM32_BASE_31_24,
    686      1.1  christos 		    B3(r->base));
    687      1.1  christos 		isapnp_write_reg(sc,
    688      1.1  christos 		    isapnp_mem32_range[i] + ISAPNP_MEM32_BASE_23_16,
    689      1.1  christos 		    B2(r->base));
    690      1.1  christos 		isapnp_write_reg(sc,
    691      1.1  christos 		    isapnp_mem32_range[i] + ISAPNP_MEM32_BASE_15_8,
    692      1.1  christos 		    B1(r->base));
    693      1.1  christos 		isapnp_write_reg(sc,
    694      1.1  christos 		    isapnp_mem32_range[i] + ISAPNP_MEM32_BASE_7_0,
    695      1.1  christos 		    B0(r->base));
    696      1.1  christos 
    697      1.1  christos 		isapnp_write_reg(sc,
    698      1.1  christos 		    isapnp_mem32_range[i] + ISAPNP_MEM32_LRANGE_31_24,
    699      1.1  christos 		    B3(r->length));
    700      1.1  christos 		isapnp_write_reg(sc,
    701      1.1  christos 		    isapnp_mem32_range[i] + ISAPNP_MEM32_LRANGE_23_16,
    702      1.1  christos 		    B2(r->length));
    703      1.1  christos 		isapnp_write_reg(sc,
    704      1.1  christos 		    isapnp_mem32_range[i] + ISAPNP_MEM32_LRANGE_15_8,
    705      1.1  christos 		    B1(r->length));
    706      1.1  christos 		isapnp_write_reg(sc,
    707      1.1  christos 		    isapnp_mem32_range[i] + ISAPNP_MEM32_LRANGE_7_0,
    708      1.1  christos 		    B0(r->length));
    709      1.1  christos 	}
    710      1.1  christos }
    711      1.1  christos 
    712      1.1  christos 
    713      1.1  christos /* isapnp_match():
    714      1.1  christos  *	Probe routine
    715      1.1  christos  */
    716      1.1  christos static int
    717      1.1  christos isapnp_match(parent, match, aux)
    718      1.1  christos 	struct device *parent;
    719      1.1  christos 	void *match, *aux;
    720      1.1  christos {
    721      1.1  christos 	int rv;
    722      1.1  christos 	struct isapnp_softc sc;
    723      1.1  christos 	struct isa_attach_args *ia = aux;
    724      1.1  christos 
    725      1.1  christos 	sc.sc_iot = ia->ia_iot;
    726      1.1  christos 	ia->ia_iobase = ISAPNP_ADDR;
    727      1.1  christos 	ia->ia_iosize = 1;
    728      1.1  christos 	(void) strcpy(sc.sc_dev.dv_xname, "(isapnp probe)");
    729      1.1  christos 
    730      1.1  christos 	if (isapnp_map(&sc))
    731      1.1  christos 		return 0;
    732      1.1  christos 
    733      1.1  christos 	rv = isapnp_find(&sc);
    734      1.1  christos 
    735      1.1  christos 	isapnp_unmap(&sc);
    736      1.1  christos 
    737      1.1  christos 	return (rv);
    738      1.1  christos }
    739      1.1  christos 
    740      1.1  christos 
    741      1.1  christos /* isapnp_attach
    742      1.1  christos  *	Find and attach PnP cards.
    743      1.1  christos  */
    744      1.1  christos static void
    745      1.1  christos isapnp_attach(parent, self, aux)
    746      1.1  christos 	struct device *parent, *self;
    747      1.1  christos 	void *aux;
    748      1.1  christos {
    749      1.1  christos 	struct isapnp_softc *sc = (struct isapnp_softc *) self;
    750      1.1  christos 	struct isa_attach_args *ia = aux;
    751      1.1  christos 	int c, d;
    752      1.1  christos 
    753      1.1  christos 	sc->sc_iot = ia->ia_iot;
    754      1.1  christos 	sc->sc_memt = ia->ia_memt;
    755      1.1  christos 	sc->sc_ncards = 0;
    756      1.1  christos 
    757      1.1  christos 	if (isapnp_map(sc))
    758      1.1  christos 		panic("%s: bus map failed\n", sc->sc_dev.dv_xname);
    759      1.1  christos 
    760      1.1  christos 	if (!isapnp_find(sc))
    761      1.1  christos 		panic("%s: no devices found\n", sc->sc_dev.dv_xname);
    762      1.1  christos 
    763      1.1  christos 	printf(": read port 0x%x\n", sc->sc_read_port);
    764      1.1  christos 
    765      1.1  christos 	for (c = 0; c < sc->sc_ncards; c++) {
    766      1.1  christos 		struct isapnp_attach_args *ipa, *lpa;
    767      1.1  christos 
    768      1.1  christos 		/* Good morning card c */
    769      1.1  christos 		isapnp_write_reg(sc, ISAPNP_WAKE, c + 1);
    770      1.1  christos 
    771      1.1  christos 		if ((ipa = isapnp_get_resource(sc, c)) == NULL)
    772      1.1  christos 			continue;
    773      1.1  christos 
    774      1.1  christos 
    775      1.1  christos 		DPRINTF(("Selecting attachments\n"));
    776      1.1  christos 		for (d = 0; (lpa = isapnp_bestconfig(sc, &ipa)) != NULL; d++) {
    777      1.1  christos 			isapnp_write_reg(sc, ISAPNP_LOGICAL_DEV_NUM, d);
    778      1.1  christos 			isapnp_configure(sc, lpa);
    779      1.1  christos #ifdef DEBUG_ISAPNP
    780      1.1  christos 			{
    781      1.1  christos 				struct isapnp_attach_args pa;
    782      1.1  christos 				isapnp_get_config(sc, &pa);
    783      1.1  christos 				isapnp_print_config(&pa);
    784      1.1  christos 			}
    785      1.1  christos #endif
    786      1.1  christos 
    787      1.1  christos #ifdef DEBUG
    788      1.1  christos 			/* XXX do we even really need this?  --thorpej */
    789      1.1  christos 			printf("%s: configuring <%s, %s, %s>\n",
    790      1.1  christos 			    sc->sc_dev.dv_xname,
    791      1.1  christos 			    lpa->ipa_devident, lpa->ipa_devlogic,
    792      1.1  christos 			    lpa->ipa_devclass);
    793      1.1  christos #endif
    794      1.1  christos 
    795      1.1  christos 			if (lpa->ipa_pref == ISAPNP_DEP_CONFLICTING) {
    796      1.1  christos 				printf("%s: <%s, %s, %s> ignored; %s\n",
    797      1.1  christos 				    sc->sc_dev.dv_xname,
    798      1.1  christos 				    lpa->ipa_devident, lpa->ipa_devlogic,
    799      1.1  christos 				    lpa->ipa_devclass, "resource conflict");
    800      1.1  christos 				ISAPNP_FREE(lpa);
    801      1.1  christos 				continue;
    802      1.1  christos 			}
    803      1.1  christos 
    804      1.1  christos 			lpa->ipa_ic = ia->ia_ic;
    805      1.1  christos 			lpa->ipa_iot = ia->ia_iot;
    806      1.1  christos 			lpa->ipa_memt = ia->ia_memt;
    807  1.4.2.1   thorpej 			ipa->ipa_dmat = ia->ia_dmat;
    808      1.1  christos 
    809      1.1  christos 			isapnp_write_reg(sc, ISAPNP_ACTIVATE, 1);
    810      1.1  christos #ifdef _KERNEL
    811      1.1  christos 			if(config_found_sm(self, lpa, isapnp_print,
    812      1.1  christos 			    isapnp_submatch) == NULL)
    813      1.1  christos 				isapnp_write_reg(sc, ISAPNP_ACTIVATE, 0);
    814      1.1  christos #else
    815      1.1  christos 			isapnp_print(lpa, NULL);
    816      1.1  christos 			printf("\n");
    817      1.1  christos #endif
    818      1.1  christos 			ISAPNP_FREE(lpa);
    819      1.1  christos 		}
    820      1.1  christos 		isapnp_write_reg(sc, ISAPNP_WAKE, 0);    /* Good night cards */
    821      1.1  christos 	}
    822      1.1  christos }
    823