/* $OpenBSD: isapnp.c,v 1.5 1996/08/16 08:35:01 deraadt Exp $ */ /* * Copyright (c) 1996, Shawn Hsiao * 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. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``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 OR CONTRIBUTORS 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. */ /* * Note: Most of the basic code was originally written by Sujal M. Patel, * plus some code takes from his pnpinfo(8). */ /* * Copyright (c) 1996, Sujal M. Patel * 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. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``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 OR CONTRIBUTORS 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. */ #include #include #include #include #include #include #include #include #include "isapnpreg.h" #include "isapnpvar.h" #define SEND(d, r) { bus_io_write_1(sc->bc, sc->addrh, 0, d); \ bus_io_write_1(sc->bc, sc->wdh, 0, r); } int isapnpmatch __P((struct device *, void *, void *)); void isapnpattach __P((struct device *, struct device *, void *)); int isapnpprint __P((void *aux, char *pnp)); int isapnpsubmatch __P((struct device *parent, void *match, void *aux)); struct isapnp_softc { struct device sc_dev; struct device *parent; bus_chipset_tag_t bc; bus_io_handle_t addrh; bus_io_handle_t wdh; bus_io_handle_t rdh; int rd_offset; int rd_port; TAILQ_HEAD(, cardinfo) q_card; }; struct cfattach isapnp_ca = { sizeof(struct isapnp_softc), isapnpmatch, isapnpattach }; struct cfdriver isapnp_cd = { NULL, "isapnp", DV_DULL, 1 }; static int isapnpquery __P((struct isapnp_softc *sc, u_int32_t dev_id, struct isa_attach_args *ia)); static void send_Initiation_LFSR __P((struct isapnp_softc *sc)); static int get_serial __P((struct isapnp_softc *sc, unsigned char *data)); static int isolation_protocol __P((struct isapnp_softc *sc)); static void read_config __P((struct isapnp_softc *sc, struct cardinfo *card, int csn)); static int get_resource_info __P((struct isapnp_softc *sc, char *buffer, int len)); static void config_device __P((struct isapnp_softc *sc, struct isa_attach_args *data)); static int find_free_irq __P((int irq_mask)); static int find_free_drq __P((int drq_mask)); static int find_free_io __P((struct isapnp_softc *sc, int desc, int min_addr, int max_addr, int size, int alignment, int range_check)); int isapnpmatch(parent, match, aux) struct device *parent; void *match, *aux; { struct isa_attach_args *ia = aux; /* sure we exist */ ia->ia_iosize = 0; return(1); } void isapnpattach(parent, self, aux) struct device *parent, *self; void *aux; { struct isa_softc *isc = (void *)parent; struct isapnp_softc *sc = (void *)self; struct isa_attach_args *ia = aux; struct cardinfo *card; int iobase; int num_pnp_devs; /* * a reference to corresponding isapnp_softc */ isc->pnpsc = sc; sc->bc = ia->ia_bc; sc->parent = parent; TAILQ_INIT(&sc->q_card); /* * WRITE_DATA port is located at fixed offset (0x0800) * from ADDRESS port, * and valid READ_DATA ports are from 0x203 to 0x3ff. */ if (bus_io_map(sc->bc, ADDRESS, 1, &(sc->addrh)) || bus_io_map(sc->bc, ADDRESS+0x0800, 1, &(sc->wdh)) || bus_io_map(sc->bc, 0x0200, 0x200, &(sc->rdh))) panic("isapnpattach: io mapping failed"); /* Try various READ_DATA ports from 0x203-0x3ff */ for (sc->rd_port = 0x80; (sc->rd_port < 0xff); sc->rd_port += 0x10) { num_pnp_devs = isolation_protocol(sc); if (num_pnp_devs) { printf(": readport 0x%x, %d devices", (sc->rd_port << 2) | 0x3, num_pnp_devs); break; } } if (num_pnp_devs == 0) printf(": 0 devices"); printf("\n"); } void postisapnpattach(parent, self, aux) struct device *parent, *self; void *aux; { struct isa_softc *isc = (struct isa_softc *)self; struct isapnp_softc *sc = (struct isapnp_softc *)isc->pnpsc; struct isabus_attach_args *iba = aux; struct cardinfo *card; struct devinfo *dev; for (card = sc->q_card.tqh_first; card; card = card->card_link.tqe_next) { for (dev = card->q_dev.tqh_first; dev; dev = dev->dev_link.tqe_next) { struct isa_attach_args ia; bzero(&ia, sizeof(ia)); ia.ia_bc = iba->iba_bc; ia.ia_ic = iba->iba_ic; ia.id = dev->id; ia.comp_id = dev->comp_id; ia.csn = card->csn; ia.ldn = dev->ldn; ia.ia_delayioh = isc->sc_delayioh; isapnpquery(sc, ia.id, &ia); if (!config_found_sm(self, &ia, isapnpprint, isapnpsubmatch)) { /* * supplied configuration fails, * disable the device. */ SEND(WAKE, ia.csn); SEND(SET_LDN, ia.ldn); SEND(ACTIVATE, 0); } } } } int isapnpprint(aux, pnp) void *aux; char *pnp; { register struct isa_attach_args *ia = aux; unsigned char info[4]; struct emap *io_map, *mem_map, *irq_map, *drq_map; io_map = find_emap("io"); mem_map = find_emap("mem"); irq_map = find_emap("irq"); drq_map = find_emap("drq"); bcopy(&ia->id, info, 4); if (pnp) { printf("device <%c%c%c%02x%02x> at %s", ((info[0] & 0x7c) >> 2) + 64, (((info[0] & 0x03) << 3) | ((info[1] & 0xe0) >> 5)) + 64, (info[1] & 0x1f) + 64, info[2], info[3], pnp); } if (!pnp) { if (ia->ia_iosize) printf(" port 0x%x", ia->ia_iobase); if (ia->ia_iosize > 1) { printf("-0x%x", ia->ia_iobase + ia->ia_iosize - 1); add_extent(io_map, ia->ia_iobase, ia->ia_iosize); } if (ia->ia_msize) printf(" iomem 0x%x", ia->ia_maddr); if (ia->ia_msize > 1) { printf("-0x%x", ia->ia_maddr + ia->ia_msize - 1); add_extent(mem_map, ia->ia_maddr, ia->ia_msize); } if (ia->ia_irq != IRQUNK) { printf(" irq %d", ia->ia_irq); add_extent(irq_map, ia->ia_irq, 1); } if (ia->ia_drq != DRQUNK) { printf(" drq %d", ia->ia_drq); add_extent(drq_map, ia->ia_drq, 1); } } return(UNCONF); } int isapnpsubmatch(parent, match, aux) struct device *parent; void *match, *aux; { struct device *dev = match; struct cfdata *cf = dev->dv_cfdata; struct isa_attach_args *ia = aux; int ret; if (cf->cf_pnpid == ia->id || cf->cf_pnpid == ia->comp_id) { ret = (*cf->cf_attach->ca_match)(parent, match, aux); return (ret); } return (0); } /* * given the logical device ID, return 1 if found and configured. */ int isapnpquery(sc, dev_id, ipa) struct isapnp_softc *sc; u_int32_t dev_id; struct isa_attach_args *ipa; { struct cardinfo *card; struct devinfo *dev; struct confinfo *conf; struct isa_attach_args *tmp; int irq, drq, iobase, mbase; int c, i, j, fail, success; for (card = sc->q_card.tqh_first; card; card = card->card_link.tqe_next) { for (dev = card->q_dev.tqh_first; dev; dev = dev->dev_link.tqe_next) { if (dev_id == dev->id || dev_id == dev->comp_id) { tmp = malloc(sizeof(struct isa_attach_args), M_DEVBUF, M_WAITOK); bzero(tmp, sizeof(struct isa_attach_args)); SEND(WAKE, card->csn); SEND(SET_LDN, dev->ldn); for (conf = dev->q_conf.tqh_first; conf; conf = conf->conf_link.tqe_next) { /* * BASIC CONFIGURATION */ if (conf->prio == BASIC_CONFIGURATION) { if (conf->irq[0]) { for (c = 0; conf->irq[c] && c < 2; c++) { i = conf->irq[c]->num; j = find_free_irq(i); if (j) { ipa->irq[c].num = j; /* * if the interrupt can not be configured as * low true level-triggered, * then set it to high true edge-triggered. * XXX needs rework */ if (conf->irq[c]->info & 0x08) { ipa->irq[c].type = 0x01; } else { ipa->irq[c].type = 0x10; } } } } if (conf->dma[0]) { for (c = 0; conf->dma[c] && c < 2; c++) { i = conf->dma[c]->channel; j = find_free_drq(i); if (j) { ipa->drq[c] = j; } } } if (conf->io[0]){ for (c = 0; conf->io[c] && c < 8; c++) { ipa->port[c] = find_free_io(sc, c, conf->io[c]->min_base, conf->io[c]->max_base, conf->io[c]->size, conf->io[c]->alignment, dev->io_range_check); } } /* XXX mem */ if (conf->mem[0]) { for (c = 0; conf->mem[c] && c < 4; c++) { ipa->mem[c].base = conf->mem[c]->min_base; ipa->mem[c].range = conf->mem[c]->size; } } } /* * DEPENDENT FUNCTION */ fail = 0; success = 1; if (conf->irq[0]) { for (c = 0; conf->irq[c] && c < 2; c++) { i = conf->irq[c]->num; j = find_free_irq(i); if (j) { tmp->irq[c].num = j; /* * if the interrupt can not be * low true level-triggered, * then set it to high true edge-triggered. * XXX rework */ if (conf->irq[c]->info & 0x08) { tmp->irq[c].type = 0x01; } else { tmp->irq[c].type = 0x10; } } else { fail = 1; success = 0; break; } } } if (conf->dma[0]) { for (c = 0; conf->dma[c] && c < 2; c++) { i = conf->dma[c]->channel; j = find_free_drq(i); if (j) { tmp->drq[c] = j; } else { fail = 1; success = 0; break; } } } if (conf->io[0]) { for (c = 0; conf->io[c] && c < 8; c++) { tmp->port[c] = find_free_io(sc, c, conf->io[c]->min_base, conf->io[c]->max_base, conf->io[c]->size, conf->io[c]->alignment, dev->io_range_check); if (!tmp->port[c]) { fail = 1; success = 0; break; } } } if (conf->mem[0]) { for (c = 0; conf->mem[c] && c < 4; c++) { tmp->mem[c].base = conf->mem[c]->min_base; tmp->mem[c].range = conf->mem[c]->size; if (!tmp->mem[c].base) { fail = 1; success = 0; break; } } } if (fail) { continue; } } if (!success) { return(0); } for (c = 0; c < 2; c++) { if (tmp->irq[c].num) { ipa->irq[c].num = tmp->irq[c].num; ipa->irq[c].type = tmp->irq[c].type; } } for (c = 0; c < 8; c++) { if (tmp->port[c]) { ipa->port[c] = tmp->port[c]; } } for (c = 0; c < 4; c++) { if (tmp->mem[c].base) { ipa->mem[c].base = tmp->mem[c].base; } } config_device(sc, ipa); ipa->ia_iobase = ipa->port[0]; ipa->ia_irq = ipa->irq[0].num; ipa->ia_drq = ipa->drq[0]; free(tmp, M_DEVBUF); return(1); } } } return(0); } /* * Send Initiation LFSR as described in "Plug and Play ISA Specification, * Intel May 94." */ static void send_Initiation_LFSR(sc) struct isapnp_softc *sc; { bus_chipset_tag_t bc = sc->bc; bus_io_handle_t addrh = sc->addrh; int cur, i; /* Reset the LSFR */ bus_io_write_1(bc, addrh, 0, 0); bus_io_write_1(bc, addrh, 0, 0); cur = 0x6a; bus_io_write_1(bc, addrh, 0, cur); for (i = 1; i < 32; i++) { cur = (cur >> 1) | (((cur ^ (cur >> 1)) << 7) & 0xff); bus_io_write_1(bc, addrh, 0, cur); } } /* * Get the device's serial number. Returns 1 if the serial is valid. */ static int get_serial(sc, data) struct isapnp_softc *sc; unsigned char *data; { bus_chipset_tag_t bc = sc->bc; bus_io_handle_t rdh = sc->rdh; int i, bit, valid = 0, sum = 0x6a; bzero(data, sizeof(char) * 9); sc->rd_offset = ((sc->rd_port - 0x80) << 2) | 0x3; for (i = 0; i < 72; i++) { bit = bus_io_read_1(bc, rdh, sc->rd_offset) == 0x55; delay(250); /* Delay 250 usec */ /* Can't Short Circuit the next evaluation, so 'and' is last */ bit = (bus_io_read_1(bc, rdh, sc->rd_offset) == 0xaa) && bit; delay(250); /* Delay 250 usec */ valid = valid || bit; if (i < 64) sum = (sum >> 1) | (((sum ^ (sum >> 1) ^ bit) << 7) & 0xff); data[i / 8] = (data[i / 8] >> 1) | (bit ? 0x80 : 0); } valid = valid && (data[8] == sum); return valid; } static int get_resource_info(sc, buffer, len) struct isapnp_softc *sc; char *buffer; int len; { int i, j; for (i = 0; i < len; i++) { bus_io_write_1(sc->bc, sc->addrh, 0, STATUS); for (j = 0; j < 100; j++) { if ((bus_io_read_1(sc->bc, sc->rdh, sc->rd_offset)) & 0x1) break; delay(1); } if (j == 100) { printf("%s: failed to report resource data\n", sc->sc_dev.dv_xname); return 0; } bus_io_write_1(sc->bc, sc->addrh, 0, RESOURCE_DATA); buffer[i] = bus_io_read_1(sc->bc, sc->rdh, sc->rd_offset); } return 1; } /* * Small Resource Tag Handler * * Returns 1 if checksum was valid (and an END_TAG was received). * Returns -1 if checksum was invalid (and an END_TAG was received). * Returns 0 for other tags. * * XXX checksum is ignored now ... */ static int handle_small_res(resinfo, item, len, card) unsigned char *resinfo; int item, len; struct cardinfo *card; { int i; switch (item) { case PNP_VERSION: bcopy(resinfo, card->pnp_version, 2); break; case LOG_DEVICE_ID: card->dev = malloc(sizeof(struct devinfo), M_DEVBUF, M_WAITOK); bzero(card->dev, sizeof(struct devinfo)); TAILQ_INSERT_TAIL(&card->q_dev, card->dev, dev_link); card->dev->id = *(u_int32_t *)resinfo; card->dev->ldn = card->num_ld; card->dev->io_range_check = resinfo[4] & 0x2 ? 1 : 0; TAILQ_INIT(&card->dev->q_conf); /* * if the resource data is not enclosed in a START_DEPEND_FUNC and * a END_DEPEND_FUNC, it's the basic configuration. * * we simple treat is as a special case. */ card->dev->basic = malloc(sizeof(struct confinfo), M_DEVBUF, M_WAITOK); TAILQ_INSERT_TAIL(&card->dev->q_conf, card->dev->basic, conf_link); card->dev->basic->prio = BASIC_CONFIGURATION; bzero(card->dev->basic->irq, 2*sizeof(void *)); bzero(card->dev->basic->dma, 2*sizeof(void *)); bzero(card->dev->basic->io, 8*sizeof(void *)); bzero(card->dev->basic->mem, 4*sizeof(void *)); card->dev->conf = card->dev->basic; card->num_ld++; break; case COMP_DEVICE_ID: card->dev->comp_id = *(u_int32_t *)resinfo; break; case IRQ_FORMAT: for (i = 0; card->dev->conf->irq[i]; i++) ; card->dev->conf->irq[i] = malloc(sizeof(struct irq_format), M_DEVBUF, M_WAITOK); card->dev->conf->irq[i]->num = resinfo[0] | resinfo[1] << 8; if (len == 3) { card->dev->conf->irq[i]->info = resinfo[2]; } else { card->dev->conf->irq[i]->info = 0; } break; case DMA_FORMAT: for (i = 0; card->dev->conf->dma[i]; i++) ; card->dev->conf->dma[i] = malloc(sizeof(struct dma_format), M_DEVBUF, M_WAITOK); card->dev->conf->dma[i]->channel = resinfo[0]; card->dev->conf->dma[i]->info = resinfo[1]; break; case START_DEPEND_FUNC: card->dev->conf = malloc(sizeof(struct confinfo), M_DEVBUF, M_WAITOK); TAILQ_INSERT_TAIL(&card->dev->q_conf, card->dev->conf, conf_link); card->dev->conf->prio = ACCEPTABLE_CONFIGURATION; bzero(card->dev->conf->irq, 2*sizeof(void *)); bzero(card->dev->conf->dma, 2*sizeof(void *)); bzero(card->dev->conf->io, 8*sizeof(void *)); bzero(card->dev->conf->mem, 4*sizeof(void *)); if (len == 1) { switch (resinfo[0]) { case GOOD_CONFIGURATION: card->dev->conf->prio = GOOD_CONFIGURATION; break; case ACCEPTABLE_CONFIGURATION: card->dev->conf->prio = ACCEPTABLE_CONFIGURATION; break; case SUBOPTIMAL_CONFIGURATION: card->dev->conf->prio = SUBOPTIMAL_CONFIGURATION; break; default: card->dev->conf->prio = RESERVED_CONFIGURATION; break; } } break; case END_DEPEND_FUNC: break; case IO_PORT_DESC: for (i = 0; card->dev->conf->io[i]; i++) ; card->dev->conf->io[i] = malloc(sizeof(struct io_descriptor), M_DEVBUF, M_WAITOK); card->dev->conf->io[i]->type = 0; /* 0 for normal I/O desc. */ card->dev->conf->io[i]->info = resinfo[0]; card->dev->conf->io[i]->min_base = resinfo[1] | resinfo[2] << 8; card->dev->conf->io[i]->max_base = resinfo[3] | resinfo[4] << 8; card->dev->conf->io[i]->alignment = resinfo[5]; card->dev->conf->io[i]->size = resinfo[6]; break; case FIXED_IO_PORT_DESC: for (i = 0; card->dev->conf->io[i]; i++) ; card->dev->conf->io[i] = malloc(sizeof(struct io_descriptor), M_DEVBUF, M_WAITOK); card->dev->conf->io[i]->type = 1; /* 1 for fixed I/O desc. */ card->dev->conf->io[i]->info = 0; card->dev->conf->io[i]->min_base = resinfo[0] | (resinfo[1] & 0x3) << 8; card->dev->conf->io[i]->max_base = card->dev->conf->io[i]->min_base; card->dev->conf->io[i]->alignment = 0; card->dev->conf->io[i]->size = resinfo[2]; break; case END_TAG: /* * XXX checksum is ignored */ return(1); } return(0); } static void handle_large_res(resinfo, item, len, card) unsigned char *resinfo; int item, len; struct cardinfo *card; { int i; switch (item) { case MEMORY_RANGE_DESC: for (i = 0; card->dev->conf->mem[i]; i++) ; card->dev->conf->mem[i] = malloc(sizeof(struct mem_descriptor), M_DEVBUF, M_WAITOK); card->dev->conf->mem[i]->type = 0; /* 0 for 24bit mem desc. */ card->dev->conf->mem[i]->info = resinfo[0]; card->dev->conf->mem[i]->min_base = (resinfo[1] | resinfo[2] << 8) << 8; card->dev->conf->mem[i]->max_base = (resinfo[3] | resinfo[4] << 8) << 8; card->dev->conf->mem[i]->alignment = (resinfo[5] | resinfo[6] << 8); if (!card->dev->conf->mem[i]->alignment) card->dev->conf->mem[i]->alignment = 1 << 16; card->dev->conf->mem[i]->size = (resinfo[7] | resinfo[8] << 8) << 8; break; case ID_STRING_ANSI: if (card->dev) { card->dev->id_string = (char *)malloc(len+1, M_DEVBUF, M_WAITOK); strncpy(card->dev->id_string, resinfo, len+1); card->dev->id_string[len] = '\0'; } else { card->id_string = (char *)malloc(len+1, M_DEVBUF, M_WAITOK); strncpy(card->id_string, resinfo, len+1); card->id_string[len] = '\0'; } break; case ID_STRING_UNICODE: break; case LG_VENDOR_DEFINED: break; case _32BIT_MEM_RANGE_DESC: break; case _32BIT_FIXED_LOC_DESC: break; case LG_RES_RESERVED: break; } } static void read_config(sc, card, csn) struct isapnp_softc *sc; struct cardinfo *card; int csn; { u_char serial[9], tag, *resinfo; int i, large_len; /* * set card with csn to Config state */ SEND(SET_CSN, csn); /* * since we are in the card isolation process, so ther's no reason * to rewind and skip the first 9 bytes */ /* * allow up to 1KB of resource info, should be plenty */ for (i = 0; i < 1024; i++) { if (!get_resource_info(sc, &tag, 1)) return; #define TYPE (tag >> 7) #define S_ITEM (tag >> 3) #define S_LEN (tag & 0x7) #define L_ITEM (tag & 0x7f) if (TYPE == 0) { resinfo = malloc(S_LEN, M_TEMP, M_WAITOK); if (!get_resource_info(sc, resinfo, S_LEN)) return; if (handle_small_res(resinfo, S_ITEM, S_LEN, card) == 1) return; free(resinfo, M_TEMP); } else { large_len = 0; if (!get_resource_info(sc, (char *)&large_len, 2)) return; resinfo = malloc(large_len, M_TEMP, M_WAITOK); if (!get_resource_info(sc, resinfo, large_len)) return; handle_large_res(resinfo, L_ITEM, large_len, card); free(resinfo, M_TEMP); } } } /* * Run the isolaion protocol. Use rd_port as the READ_DATA port value (caller * should try multiple READ_DATA locations before giving up). Upon exiting, * all cards are aware that they should use rd_port as the READ_DATA port; */ static int isolation_protocol(sc) struct isapnp_softc *sc; { int csn; unsigned char data[9]; /* Reset CSN for All Cards */ SEND(CONFIG_CONTROL, 0x05); send_Initiation_LFSR(sc); for (csn = 1; (csn < MAX_CARDS); csn++) { /* Wake up cards without a CSN */ SEND(WAKE, 0); SEND(SET_RD_DATA, sc->rd_port); bus_io_write_1(sc->bc, sc->addrh, 0, SERIAL_ISOLATION); delay(1000); /* Delay 1 msec */ if (get_serial(sc, data)) { struct cardinfo *card; SEND(SET_CSN, csn); card = malloc(sizeof(struct cardinfo), M_DEVBUF, M_WAITOK); bzero(card, sizeof(struct cardinfo)); TAILQ_INSERT_TAIL(&sc->q_card, card, card_link); bcopy(data, card->serial, 9); card->csn = csn; TAILQ_INIT(&card->q_dev); /* * read card's resource data */ read_config(sc, card, csn); } else break; } return csn - 1; } /* * Configure PnP devices, given a set of configuration data */ static void config_device(sc, data) struct isapnp_softc *sc; struct isa_attach_args *data; { int i; if (data->csn <= 0) { return; } #if 0 printf ("%s: configuring CSN %x (logical device %x)\n", sc->sc_dev.dv_xname, data->csn, data->ldn != -1 ? data->ldn : 0); #endif SEND(WAKE, data->csn); if (data->ldn > 0) SEND (SET_LDN, data->ldn); for (i = 0; i < 8; i++) if (data->port[i] > 0) { SEND (IO_CONFIG_BASE + i * 2, data->port[i] >> 8); SEND (IO_CONFIG_BASE + i * 2 + 1, data->port[i] & 0xff); } for (i = 0; i < 2; i++) if (data->irq[i].num > 0) { SEND (IRQ_CONFIG + i * 2, data->irq[i].num); if (data->irq[i].type >= 0) SEND (IRQ_CONFIG + i * 2 + 1, data->irq[i].type); } for (i = 0; i < 2; i++) if (data->drq[i] > 0) { SEND (DRQ_CONFIG + i, data->drq[i]); } for (i = 0; i < 4; i++) if (data->mem[i].base > 0) { SEND (MEM_CONFIG + i * 8, data->mem[i].base >> 16); SEND (MEM_CONFIG + i * 8 + 1, (data->mem[i].base >> 8) & 0xff); /* * This needs to be handled better for * the user's sake. XXX */ if (data->mem[i].control >= 0) { SEND (MEM_CONFIG + i * 8 + 2, data->mem[i].control); } SEND (MEM_CONFIG + i * 8 + 3, data->mem[i].range >> 16); SEND (MEM_CONFIG + i * 8 + 4, (data->mem[i].range >> 8) & 0xff); } SEND (IO_RANGE_CHECK, 0); SEND (ACTIVATE, 1); } static int find_free_irq(irq_mask) int irq_mask; { int i, j; struct emap *irq_map; irq_map = find_emap("irq"); i = irq_mask; while (1) { j = ffs(i); if (!j) { return(0); } /* * irq_mask is starting from 0 */ j --; if (!probe_extent(irq_map, j, 1)) { return(j); } i &= ~(0x1 << j); } } int find_free_drq(drq_mask) int drq_mask; { int i, j; struct emap *drq_map; drq_map = find_emap("drq"); i = drq_mask; while (1) { j = ffs(i); if (!j) { return(0); } /* * drq_mask is starting from 0 */ j --; if (!probe_extent(drq_map, j, 1)) { return(j); } i &= ~(0x1 << j); } } /* * find free I/O space. * if device is capable of doing I/O range check, then use it. * else, try to find free region from extent map. * * assume caller has set csn and ldn properly. */ static int find_free_io(sc, desc, min_addr, max_addr, size, alignment, range_check) struct isapnp_softc *sc; int desc, min_addr, max_addr, size, alignment, range_check; { int addr, i, success = 0; bus_io_handle_t data; struct emap *io_map; if (range_check) { for (addr = min_addr; addr <= max_addr; addr += alignment) { SEND(ACTIVATE, 0); SEND(IO_CONFIG_BASE + desc * 2, addr >> 8); SEND(IO_CONFIG_BASE + desc * 2 + 1, addr & 0xff); SEND(IO_RANGE_CHECK, 0x2); bus_io_map(sc->bc, addr, size, &data); i = 0; for (i = 0; i < size; i++) { if (bus_io_read_1(sc->bc, data, i) != 0xAA) { bus_io_unmap(sc->bc, data, size); break; } } if (i == size) { success = 1; bus_io_unmap(sc->bc, data, size); break; } } if (success) { return(addr); } else { return(0); } } else { io_map = find_emap("io"); addr = min_addr; if (!probe_extent(io_map, addr, size)) { return(addr); } return(0); } }