/* $NetBSD: isapnp.c,v 1.15 1998/01/12 09:27:14 thorpej Exp $ */ /* * Copyright (c) 1996 Christos Zoulas. All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by Christos Zoulas. * 4. The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ /* * ISA PnP bus autoconfiguration. */ #include #include #include #include #include #include #include #include #include static void isapnp_init __P((struct isapnp_softc *)); static __inline u_char isapnp_shift_bit __P((struct isapnp_softc *)); static int isapnp_findcard __P((struct isapnp_softc *)); static void isapnp_free_region __P((bus_space_tag_t, struct isapnp_region *)); static int isapnp_alloc_region __P((bus_space_tag_t, struct isapnp_region *)); static int isapnp_alloc_irq __P((isa_chipset_tag_t, struct isapnp_pin *)); static int isapnp_alloc_drq __P((struct device *, struct isapnp_pin *)); static int isapnp_testconfig __P((bus_space_tag_t, bus_space_tag_t, struct isapnp_attach_args *, int)); static struct isapnp_attach_args *isapnp_bestconfig __P((struct device *, struct isapnp_softc *, struct isapnp_attach_args **)); static void isapnp_print_region __P((const char *, struct isapnp_region *, size_t)); static void isapnp_configure __P((struct isapnp_softc *, const struct isapnp_attach_args *)); static void isapnp_print_pin __P((const char *, struct isapnp_pin *, size_t)); static int isapnp_print __P((void *, const char *)); #ifdef _KERNEL #ifdef __BROKEN_INDIRECT_CONFIG static int isapnp_submatch __P((struct device *, void *, void *)); #else static int isapnp_submatch __P((struct device *, struct cfdata *, void *)); #endif #endif static int isapnp_find __P((struct isapnp_softc *, int)); #ifdef __BROKEN_INDIRECT_CONFIG static int isapnp_match __P((struct device *, void *, void *)); #else static int isapnp_match __P((struct device *, struct cfdata *, void *)); #endif static void isapnp_attach __P((struct device *, struct device *, void *)); struct cfattach isapnp_ca = { sizeof(struct isapnp_softc), isapnp_match, isapnp_attach }; /* isapnp_init(): * Write the PNP initiation key to wake up the cards... */ static void isapnp_init(sc) struct isapnp_softc *sc; { int i; u_char v = ISAPNP_LFSR_INIT; /* First write 0's twice to enter the Wait for Key state */ ISAPNP_WRITE_ADDR(sc, 0); ISAPNP_WRITE_ADDR(sc, 0); /* Send the 32 byte sequence to awake the logic */ for (i = 0; i < ISAPNP_LFSR_LENGTH; i++) { ISAPNP_WRITE_ADDR(sc, v); v = ISAPNP_LFSR_NEXT(v); } } /* isapnp_shift_bit(): * Read a bit at a time from the config card. */ static __inline u_char isapnp_shift_bit(sc) struct isapnp_softc *sc; { u_char c1, c2; DELAY(250); c1 = ISAPNP_READ_DATA(sc); DELAY(250); c2 = ISAPNP_READ_DATA(sc); if (c1 == 0x55 && c2 == 0xAA) return 0x80; else return 0; } /* isapnp_findcard(): * Attempt to read the vendor/serial/checksum for a card * If a card is found [the checksum matches], assign the * next card number to it and return 1 */ static int isapnp_findcard(sc) struct isapnp_softc *sc; { u_char v = ISAPNP_LFSR_INIT, csum, w; int i, b; if (sc->sc_ncards == ISAPNP_MAX_CARDS) { printf("%s: Too many pnp cards\n", sc->sc_dev.dv_xname); return 0; } /* Set the read port */ isapnp_write_reg(sc, ISAPNP_WAKE, 0); isapnp_write_reg(sc, ISAPNP_SET_RD_PORT, sc->sc_read_port >> 2); sc->sc_read_port |= 3; DELAY(1000); ISAPNP_WRITE_ADDR(sc, ISAPNP_SERIAL_ISOLATION); DELAY(1000); /* Read the 8 bytes of the Vendor ID and Serial Number */ for(i = 0; i < 8; i++) { /* Read each bit separately */ for (w = 0, b = 0; b < 8; b++) { u_char neg = isapnp_shift_bit(sc); w >>= 1; w |= neg; v = ISAPNP_LFSR_NEXT(v) ^ neg; } sc->sc_id[sc->sc_ncards][i] = w; } /* Read the remaining checksum byte */ for (csum = 0, b = 0; b < 8; b++) { u_char neg = isapnp_shift_bit(sc); csum >>= 1; csum |= neg; } sc->sc_id[sc->sc_ncards][8] = csum; if (csum == v) { sc->sc_ncards++; isapnp_write_reg(sc, ISAPNP_CARD_SELECT_NUM, sc->sc_ncards); return 1; } return 0; } /* isapnp_free_region(): * Free a region */ static void isapnp_free_region(t, r) bus_space_tag_t t; struct isapnp_region *r; { #ifdef _KERNEL bus_space_unmap(t, r->h, r->length); #endif } /* isapnp_alloc_region(): * Allocate a single region if possible */ static int isapnp_alloc_region(t, r) bus_space_tag_t t; struct isapnp_region *r; { int error = 0; for (r->base = r->minbase; r->base <= r->maxbase; r->base += r->align) { #ifdef _KERNEL error = bus_space_map(t, r->base, r->length, 0, &r->h); #endif if (error == 0) return 0; } return error; } /* isapnp_alloc_irq(): * Allocate an irq */ static int isapnp_alloc_irq(ic, i) isa_chipset_tag_t ic; struct isapnp_pin *i; { int irq; #define LEVEL_IRQ (ISAPNP_IRQTYPE_LEVEL_PLUS|ISAPNP_IRQTYPE_LEVEL_MINUS) i->type = (i->flags & LEVEL_IRQ) ? IST_LEVEL : IST_EDGE; if (i->bits == 0) { i->num = 0; return 0; } if (isa_intr_alloc(ic, i->bits, i->type, &irq) == 0) { i->num = irq; return 0; } return EINVAL; } /* isapnp_alloc_drq(): * Allocate a drq */ static int isapnp_alloc_drq(isa, i) struct device *isa; struct isapnp_pin *i; { int b; if (i->bits == 0) { i->num = 0; return 0; } for (b = 0; b < 16; b++) if ((i->bits & (1 << b)) && isa_drq_isfree(isa, b)) { i->num = b; return 0; } return EINVAL; } /* isapnp_testconfig(): * Test/Allocate the regions used */ static int isapnp_testconfig(iot, memt, ipa, alloc) bus_space_tag_t iot, memt; struct isapnp_attach_args *ipa; int alloc; { int nio = 0, nmem = 0, nmem32 = 0, nirq = 0, ndrq = 0; int error = 0; #ifdef DEBUG_ISAPNP isapnp_print_attach(ipa); #endif for (; nio < ipa->ipa_nio; nio++) { error = isapnp_alloc_region(iot, &ipa->ipa_io[nio]); if (error) goto bad; } for (; nmem < ipa->ipa_nmem; nmem++) { error = isapnp_alloc_region(memt, &ipa->ipa_mem[nmem]); if (error) goto bad; } for (; nmem32 < ipa->ipa_nmem32; nmem32++) { error = isapnp_alloc_region(memt, &ipa->ipa_mem32[nmem32]); if (error) goto bad; } for (; nirq < ipa->ipa_nirq; nirq++) { error = isapnp_alloc_irq(ipa->ipa_ic, &ipa->ipa_irq[nirq]); if (error) goto bad; } for (; ndrq < ipa->ipa_ndrq; ndrq++) { error = isapnp_alloc_drq(ipa->ipa_isa, &ipa->ipa_drq[ndrq]); if (error) goto bad; } if (alloc) return error; bad: #ifdef notyet for (ndrq--; ndrq >= 0; ndrq--) isapnp_free_pin(&ipa->ipa_drq[ndrq]); for (nirq--; nirq >= 0; nirq--) isapnp_free_pin(&ipa->ipa_irq[nirq]); #endif for (nmem32--; nmem32 >= 0; nmem32--) isapnp_free_region(memt, &ipa->ipa_mem32[nmem32]); for (nmem--; nmem >= 0; nmem--) isapnp_free_region(memt, &ipa->ipa_mem[nmem]); for (nio--; nio >= 0; nio--) isapnp_free_region(iot, &ipa->ipa_io[nio]); return error; } /* isapnp_config(): * Test/Allocate the regions used */ int isapnp_config(iot, memt, ipa) bus_space_tag_t iot, memt; struct isapnp_attach_args *ipa; { return isapnp_testconfig(iot, memt, ipa, 1); } /* isapnp_unconfig(): * Free the regions used */ void isapnp_unconfig(iot, memt, ipa) bus_space_tag_t iot, memt; struct isapnp_attach_args *ipa; { int i; #ifdef notyet for (i = 0; i < ipa->ipa_ndrq; i++) isapnp_free_pin(&ipa->ipa_drq[i]); for (i = 0; i < ipa->ipa_nirq; i++) isapnp_free_pin(&ipa->ipa_irq[i]); #endif for (i = 0; i < ipa->ipa_nmem32; i++) isapnp_free_region(memt, &ipa->ipa_mem32[i]); for (i = 0; i < ipa->ipa_nmem; i++) isapnp_free_region(memt, &ipa->ipa_mem[i]); for (i = 0; i < ipa->ipa_nio; i++) isapnp_free_region(iot, &ipa->ipa_io[i]); } /* isapnp_bestconfig(): * Return the best configuration for each logical device, remove and * free all other configurations. */ static struct isapnp_attach_args * isapnp_bestconfig(isa, sc, ipa) struct device *isa; struct isapnp_softc *sc; struct isapnp_attach_args **ipa; { struct isapnp_attach_args *c, *best, *f = *ipa; int error; for (;;) { if (f == NULL) return NULL; #define SAMEDEV(a, b) (strcmp((a)->ipa_devlogic, (b)->ipa_devlogic) == 0) /* Find the best config */ for (best = c = f; c != NULL; c = c->ipa_sibling) { if (!SAMEDEV(c, f)) continue; if (c->ipa_pref < best->ipa_pref) best = c; } best->ipa_isa = isa; /* Test the best config */ error = isapnp_testconfig(sc->sc_iot, sc->sc_memt, best, 0); /* Remove this config from the list */ if (best == f) f = f->ipa_sibling; else { for (c = f; c->ipa_sibling != best; c = c->ipa_sibling) continue; c->ipa_sibling = best->ipa_sibling; } if (error) { best->ipa_pref = ISAPNP_DEP_CONFLICTING; for (c = f; c != NULL; c = c->ipa_sibling) if (c != best && SAMEDEV(c, best)) break; /* Last config for this logical device is conflicting */ if (c == NULL) { *ipa = f; return best; } ISAPNP_FREE(best); continue; } else { /* Remove all other configs for this device */ struct isapnp_attach_args *l = NULL, *n = NULL, *d; for (c = f; c; ) { if (c == best) continue; d = c->ipa_sibling; if (SAMEDEV(c, best)) ISAPNP_FREE(c); else { if (n) n->ipa_sibling = c; else l = c; n = c; c->ipa_sibling = NULL; } c = d; } f = l; } *ipa = f; return best; } } /* isapnp_id_to_vendor(): * Convert a pnp ``compressed ascii'' vendor id to a string */ char * isapnp_id_to_vendor(v, id) char *v; const u_char *id; { static const char hex[] = "0123456789ABCDEF"; char *p = v; *p++ = 'A' + (id[0] >> 2) - 1; *p++ = 'A' + ((id[0] & 3) << 3) + (id[1] >> 5) - 1; *p++ = 'A' + (id[1] & 0x1f) - 1; *p++ = hex[id[2] >> 4]; *p++ = hex[id[2] & 0x0f]; *p++ = hex[id[3] >> 4]; *p++ = hex[id[3] & 0x0f]; *p = '\0'; return v; } /* isapnp_print_region(): * Print a region allocation */ static void isapnp_print_region(str, r, n) const char *str; struct isapnp_region *r; size_t n; { size_t i; if (n == 0) return; printf(" %s ", str); for (i = 0; i < n; i++, r++) { printf("0x%x", r->base); if (r->length) printf("/%d", r->length); if (i != n - 1) printf(","); } } /* isapnp_print_pin(): * Print an irq/drq assignment */ static void isapnp_print_pin(str, p, n) const char *str; struct isapnp_pin *p; size_t n; { size_t i; if (n == 0) return; printf(" %s ", str); for (i = 0; i < n; i++, p++) { printf("%d", p->num); if (i != n - 1) printf(","); } } /* isapnp_print(): * Print the configuration line for an ISA PnP card. */ static int isapnp_print(aux, str) void *aux; const char *str; { struct isapnp_attach_args *ipa = aux; if (str != NULL) printf("%s: <%s, %s, %s, %s>", str, ipa->ipa_devident, ipa->ipa_devlogic, ipa->ipa_devcompat, ipa->ipa_devclass); isapnp_print_region("port", ipa->ipa_io, ipa->ipa_nio); isapnp_print_region("mem", ipa->ipa_mem, ipa->ipa_nmem); isapnp_print_region("mem32", ipa->ipa_mem32, ipa->ipa_nmem32); isapnp_print_pin("irq", ipa->ipa_irq, ipa->ipa_nirq); isapnp_print_pin("drq", ipa->ipa_drq, ipa->ipa_ndrq); return UNCONF; } #ifdef _KERNEL /* isapnp_submatch(): * Probe the logical device... */ static int isapnp_submatch(parent, match, aux) struct device *parent; #ifdef __BROKEN_INDIRECT_CONFIG void *match; #else struct cfdata *match; #endif void *aux; { struct cfdata *cf = (struct cfdata *) match; return ((*cf->cf_attach->ca_match)(parent, match, aux)); } #endif /* isapnp_find(): * Probe and add cards */ static int isapnp_find(sc, all) struct isapnp_softc *sc; int all; { int p; isapnp_init(sc); isapnp_write_reg(sc, ISAPNP_CONFIG_CONTROL, ISAPNP_CC_RESET_DRV); DELAY(2000); isapnp_init(sc); DELAY(2000); for (p = ISAPNP_RDDATA_MIN; p <= ISAPNP_RDDATA_MAX; p += 4) { sc->sc_read_port = p; if (isapnp_map_readport(sc)) continue; DPRINTF(("%s: Trying port %x\n", sc->sc_dev.dv_xname, p)); if (isapnp_findcard(sc)) break; isapnp_unmap_readport(sc); } if (p > ISAPNP_RDDATA_MAX) { sc->sc_read_port = 0; return 0; } if (all) while (isapnp_findcard(sc)) continue; return 1; } /* isapnp_configure(): * Configure a PnP card * XXX: The memory configuration code is wrong. We need to check the * range/length bit an do appropriate sets. */ static void isapnp_configure(sc, ipa) struct isapnp_softc *sc; const struct isapnp_attach_args *ipa; { int i; static u_char isapnp_mem_range[] = ISAPNP_MEM_DESC; static u_char isapnp_io_range[] = ISAPNP_IO_DESC; static u_char isapnp_irq_range[] = ISAPNP_IRQ_DESC; static u_char isapnp_drq_range[] = ISAPNP_DRQ_DESC; static u_char isapnp_mem32_range[] = ISAPNP_MEM32_DESC; const struct isapnp_region *r; const struct isapnp_pin *p; struct isapnp_region rz; struct isapnp_pin pz; memset(&pz, 0, sizeof(pz)); memset(&rz, 0, sizeof(rz)); #define B0(a) ((a) & 0xff) #define B1(a) (((a) >> 8) & 0xff) #define B2(a) (((a) >> 16) & 0xff) #define B3(a) (((a) >> 24) & 0xff) for (i = 0; i < sizeof(isapnp_io_range); i++) { if (i < ipa->ipa_nio) r = &ipa->ipa_io[i]; else r = &rz; isapnp_write_reg(sc, isapnp_io_range[i] + ISAPNP_IO_BASE_15_8, B1(r->base)); isapnp_write_reg(sc, isapnp_io_range[i] + ISAPNP_IO_BASE_7_0, B0(r->base)); } for (i = 0; i < sizeof(isapnp_mem_range); i++) { if (i < ipa->ipa_nmem) r = &ipa->ipa_mem[i]; else r = &rz; isapnp_write_reg(sc, isapnp_mem_range[i] + ISAPNP_MEM_BASE_23_16, B2(r->base)); isapnp_write_reg(sc, isapnp_mem_range[i] + ISAPNP_MEM_BASE_15_8, B1(r->base)); isapnp_write_reg(sc, isapnp_mem_range[i] + ISAPNP_MEM_LRANGE_23_16, B2(r->length)); isapnp_write_reg(sc, isapnp_mem_range[i] + ISAPNP_MEM_LRANGE_15_8, B1(r->length)); } for (i = 0; i < sizeof(isapnp_irq_range); i++) { u_char v; if (i < ipa->ipa_nirq) p = &ipa->ipa_irq[i]; else p = &pz; isapnp_write_reg(sc, isapnp_irq_range[i] + ISAPNP_IRQ_NUMBER, p->num); switch (p->flags) { case ISAPNP_IRQTYPE_LEVEL_PLUS: v = ISAPNP_IRQ_LEVEL|ISAPNP_IRQ_HIGH; break; case ISAPNP_IRQTYPE_EDGE_PLUS: v = ISAPNP_IRQ_HIGH; break; case ISAPNP_IRQTYPE_LEVEL_MINUS: v = ISAPNP_IRQ_LEVEL; break; default: case ISAPNP_IRQTYPE_EDGE_MINUS: v = 0; break; } isapnp_write_reg(sc, isapnp_irq_range[i] + ISAPNP_IRQ_CONTROL, v); } for (i = 0; i < sizeof(isapnp_drq_range); i++) { u_char v; if (i < ipa->ipa_ndrq) v = ipa->ipa_drq[i].num; else v = 4; isapnp_write_reg(sc, isapnp_drq_range[i], v); } for (i = 0; i < sizeof(isapnp_mem32_range); i++) { if (i < ipa->ipa_nmem32) r = &ipa->ipa_mem32[i]; else r = &rz; isapnp_write_reg(sc, isapnp_mem32_range[i] + ISAPNP_MEM32_BASE_31_24, B3(r->base)); isapnp_write_reg(sc, isapnp_mem32_range[i] + ISAPNP_MEM32_BASE_23_16, B2(r->base)); isapnp_write_reg(sc, isapnp_mem32_range[i] + ISAPNP_MEM32_BASE_15_8, B1(r->base)); isapnp_write_reg(sc, isapnp_mem32_range[i] + ISAPNP_MEM32_BASE_7_0, B0(r->base)); isapnp_write_reg(sc, isapnp_mem32_range[i] + ISAPNP_MEM32_LRANGE_31_24, B3(r->length)); isapnp_write_reg(sc, isapnp_mem32_range[i] + ISAPNP_MEM32_LRANGE_23_16, B2(r->length)); isapnp_write_reg(sc, isapnp_mem32_range[i] + ISAPNP_MEM32_LRANGE_15_8, B1(r->length)); isapnp_write_reg(sc, isapnp_mem32_range[i] + ISAPNP_MEM32_LRANGE_7_0, B0(r->length)); } } /* isapnp_match(): * Probe routine */ static int isapnp_match(parent, match, aux) struct device *parent; #ifdef __BROKEN_INDIRECT_CONFIG void *match; #else struct cfdata *match; #endif void *aux; { int rv; struct isapnp_softc sc; struct isa_attach_args *ia = aux; sc.sc_iot = ia->ia_iot; sc.sc_ncards = 0; (void) strcpy(sc.sc_dev.dv_xname, "(isapnp probe)"); if (isapnp_map(&sc)) return 0; rv = isapnp_find(&sc, 0); ia->ia_iobase = ISAPNP_ADDR; ia->ia_iosize = 1; isapnp_unmap(&sc); if (rv) isapnp_unmap_readport(&sc); return (rv); } /* isapnp_attach * Find and attach PnP cards. */ static void isapnp_attach(parent, self, aux) struct device *parent, *self; void *aux; { struct isapnp_softc *sc = (struct isapnp_softc *) self; struct isa_attach_args *ia = aux; int c, d; sc->sc_iot = ia->ia_iot; sc->sc_memt = ia->ia_memt; sc->sc_ncards = 0; if (isapnp_map(sc)) panic("%s: bus map failed\n", sc->sc_dev.dv_xname); if (!isapnp_find(sc, 1)) panic("%s: no cards found\n", sc->sc_dev.dv_xname); printf(": read port 0x%x\n", sc->sc_read_port); for (c = 0; c < sc->sc_ncards; c++) { struct isapnp_attach_args *ipa, *lpa; /* Good morning card c */ isapnp_write_reg(sc, ISAPNP_WAKE, c + 1); if ((ipa = isapnp_get_resource(sc, c)) == NULL) continue; DPRINTF(("Selecting attachments\n")); for (d = 0; (lpa = isapnp_bestconfig(parent, sc, &ipa)) != NULL; d++) { isapnp_write_reg(sc, ISAPNP_LOGICAL_DEV_NUM, d); isapnp_configure(sc, lpa); #ifdef DEBUG_ISAPNP { struct isapnp_attach_args pa; isapnp_get_config(sc, &pa); isapnp_print_config(&pa); } #endif DPRINTF(("%s: configuring <%s, %s, %s, %s>\n", sc->sc_dev.dv_xname, lpa->ipa_devident, lpa->ipa_devlogic, lpa->ipa_devcompat, lpa->ipa_devclass)); if (lpa->ipa_pref == ISAPNP_DEP_CONFLICTING) { printf("%s: <%s, %s, %s, %s> ignored; %s\n", sc->sc_dev.dv_xname, lpa->ipa_devident, lpa->ipa_devlogic, lpa->ipa_devcompat, lpa->ipa_devclass, "resource conflict"); ISAPNP_FREE(lpa); continue; } lpa->ipa_ic = ia->ia_ic; lpa->ipa_iot = ia->ia_iot; lpa->ipa_memt = ia->ia_memt; lpa->ipa_dmat = ia->ia_dmat; isapnp_write_reg(sc, ISAPNP_ACTIVATE, 1); #ifdef _KERNEL if (config_found_sm(self, lpa, isapnp_print, isapnp_submatch) == NULL) isapnp_write_reg(sc, ISAPNP_ACTIVATE, 0); #else isapnp_print(lpa, NULL); printf("\n"); #endif ISAPNP_FREE(lpa); } isapnp_write_reg(sc, ISAPNP_WAKE, 0); /* Good night cards */ } }