/* $Id: cardbus.c,v 1.1.2.1 1999/02/16 16:44:35 haya Exp $ */ /* * Copyright (c) 1997 and 1998 HAYAKAWA Koichi. 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 HAYAKAWA Koichi. * 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. */ /* FreeBSD/newconfig version. UCHIYAMA Yasushi 1999 */ /* $FreeBSD$ */ #define CARDBUS_DEBUG #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #if defined CARDBUS_DEBUG #define STATIC #define DPRINTF(a) printf a #define DDELAY(x) delay((x)*1000*1000) #else #define STATIC static #define DPRINTF(a) #endif STATIC void cardbusattach __P((struct device *, struct device *, void *)); STATIC int cardbusmatch __P((struct device *, struct cfdata *, void *)); static int cardbussubmatch __P((struct device *, struct cfdata *, void *)); static int cardbusprint __P((void *, const char *)); static u_int8_t *decode_tuple __P((u_int8_t *)); static int decode_tuples __P((u_int8_t *, int)); static char *tuple_name __P((int)); struct cfattach cardbus_ca = { sizeof(struct cardbus_softc), cardbusmatch, cardbusattach }; STATIC int cardbusmatch(parent, cf, aux) struct device *parent; struct cfdata *cf; void *aux; { struct cbslot_attach_args *cba = aux; /* which slot? */ if (cf->cbslotcf_slot != CBSLOT_UNK_SLOT && cf->cbslotcf_slot != cba->cba_function) { DPRINTF(("cardbusmatch: function differs %d <=> %d\n", cf->cbslotcf_slot, cba->cba_function)); return 0; } if (cba->cba_function < 0 || cba->cba_function > 255) { return 0; } return 1; } void cardslot_if_setup (struct cardbus_softc *csc) { csc->sc_if.if_card_attach = cardbus_attach_card; } STATIC void cardbusattach(parent, self, aux) struct device *parent; struct device *self; void *aux; { struct pccbb_softc *psc = (struct pccbb_softc *)parent; struct cardbus_softc *sc = (void *)self; struct cbslot_attach_args *cba = aux; int cdstatus; sc->sc_bus = cba->cba_bus; sc->sc_device = cba->cba_function; sc->sc_intrline = cba->cba_intrline; printf(" bus %d device %d\n", sc->sc_bus, sc->sc_device); sc->sc_iot = cba->cba_iot; /* CardBus I/O space tag */ sc->sc_memt = cba->cba_memt; /* CardBus MEM space tag */ sc->sc_dmat = cba->cba_dmat; /* DMA tag */ sc->sc_cc = cba->cba_cc; sc->sc_cf = cba->cba_cf; cardslot_if_setup (sc); cdstatus = 0; if ((cdstatus = (sc->sc_cf->cardbus_ctrl)(sc->sc_cc, CARDBUS_CD))) { DPRINTF(("cardbusattach: CardBus card found [0x%x]\n", cdstatus)); psc->sc_cbdev = cardbus_attach_card(sc); } } /********************************************************************** * int cardbus_attach_card(struct cardbus_softc *sc) * This functions attaches the card on the slot: turns on power, * reads and analyses tuple, sets consifuration index. ***********************************************************************/ struct device * cardbus_attach_card(sc) struct cardbus_softc *sc; { struct device *attached_device = NULL; cardbus_chipset_tag_t cc; cardbus_function_tag_t cf; int cdstatus; cardbustag_t tag; cardbusreg_t id, class, cis_ptr, bhlcr; u_int8_t tuple[2048]; int function, max_func, device; cc = sc->sc_cc; cf = sc->sc_cf; DPRINTF(("cardbus_attach_card: cb%d start\n", sc->sc_dev.dv_unit)); /* inspect initial voltage */ if (0 == (cdstatus = (cf->cardbus_ctrl)(cc, CARDBUS_CD))) { DPRINTF(("cardbusattach: no CardBus card on cb%d\n", sc->sc_dev.dv_unit)); return 0; } if (cdstatus & CARDBUS_3V_CARD) { cf->cardbus_power(cc, CARDBUS_VCC_3V); } (cf->cardbus_ctrl)(cc, CARDBUS_RESET); device = 0; /* Only one card can attach cardbus slot */ function = 0; tag = cardbus_make_tag (cc, cf, sc->sc_bus, device, function); bhlcr = (cf->cardbus_conf_read)(cc, tag, CARDBUS_BHLC_REG); max_func = CARDBUS_HDRTYPE_MULTIFN(bhlcr) ? 8 : 1; for (function = 0; function < max_func; function++) { if (function) tag = cardbus_make_tag (cc, cf, sc->sc_bus, device, function); id = (cf->cardbus_conf_read)(cc, tag, CARDBUS_ID_REG); if (CARDBUS_VENDOR(id) == 0xffff || CARDBUS_VENDOR(id) == 0) { cardbus_free_tag (cc, cf, tag); continue; } class = (cf->cardbus_conf_read)(cc, tag, CARDBUS_CLASS_REG); cis_ptr = (cf->cardbus_conf_read)(cc, tag, CARDBUS_CIS_REG); DPRINTF(("cardbus_attach_card: Vendor 0x%x, Product 0x%x, CIS 0x%x\n", CARDBUS_VENDOR(id), CARDBUS_PRODUCT(id), cis_ptr)); bzero(tuple, 2048); if (0 == (cis_ptr & CARDBUS_CIS_ASIMASK)) { int i = cis_ptr & CARDBUS_CIS_ADDRMASK; int j = 0; for (; i < 0xff; i += 4) { u_int32_t e = (cf->cardbus_conf_read)(cc, tag, i); tuple[j] = 0xff & e; e >>= 8; tuple[j + 1] = 0xff & e; e >>= 8; tuple[j + 2] = 0xff & e; e >>= 8; tuple[j + 3] = 0xff & e; j += 4; } } decode_tuples(tuple, 2048); if (function == 0) { struct cardbus_attach_args ca; cardbusreg_t intr = cardbus_conf_read(cc, cf, tag, CARDBUS_INTERRUPT_REG); ca.ca_unit = sc->sc_dev.dv_unit; ca.ca_cc = sc->sc_cc; ca.ca_cf = sc->sc_cf; ca.ca_iot = sc->sc_iot; ca.ca_memt = sc->sc_memt; ca.ca_dmat = sc->sc_dmat; ca.ca_tag = tag; ca.ca_device = device; ca.ca_function = function; ca.ca_id = id; ca.ca_class = class; ca.ca_intrline = sc->sc_intrline; attached_device = config_found_sm((void *)sc, &ca, cardbusprint, cardbussubmatch); } else { printf ("cardbus_attach_card: XXX Multi-function can't handle. function 0 only.\n"); } cardbus_free_tag (cc, cf, tag); } if (!attached_device) cf->cardbus_power(cc, CARDBUS_VCC_0V); return attached_device; } static int cardbussubmatch(parent, cf, aux) struct device *parent; struct cfdata *cf; void *aux; { struct cardbus_attach_args *ca = aux; if (cf->cardbuscf_dev != CARDBUS_UNK_DEV && cf->cardbuscf_dev != ca->ca_unit) { return 0; } if (cf->cardbuscf_function != CARDBUS_UNK_FUNCTION && cf->cardbuscf_function != ca->ca_function) { return 0; } return ((*cf->cf_attach->ca_match)(parent, cf, aux)); } static int cardbusprint(aux, pnp) void *aux; const char *pnp; { register struct cardbus_attach_args *ca = aux; char devinfo[256]; if (pnp) { printf("vendor 0x%04x id 0x%04x at %s", CARDBUS_VENDOR(ca->ca_id), CARDBUS_PRODUCT(ca->ca_id), pnp); } printf(" dev %d function %d", ca->ca_device, ca->ca_function); return UNCONF; } /********************************************************************** * void *cardbus_intr_establish(cc, cf, irq, level, func, arg) * Interrupt handler of pccard. * args: * cardbus_chipset_tag_t *cc * int irq: **********************************************************************/ void * cardbus_intr_establish(cc, cf, irq, level, func, arg) cardbus_chipset_tag_t cc; cardbus_function_tag_t cf; cardbus_intr_handle_t irq; int level; int (*func) __P((void *)); void *arg; { DPRINTF(("- cardbus_intr_establish: irq %d\n", irq)); return (*cf->cardbus_intr_establish)(cc, irq, level, func, arg); } /********************************************************************** * void cardbus_intr_disestablish(cc, cf, handler) * Interrupt handler of pccard. * args: * cardbus_chipset_tag_t *cc **********************************************************************/ void cardbus_intr_disestablish(cc, cf, handler) cardbus_chipset_tag_t cc; cardbus_function_tag_t cf; void *handler; { DPRINTF(("- cardbus_intr_disestablish\n")); (*cf->cardbus_intr_disestablish)(cc, handler); return; } /********************************************************************** * below this line, there are some functions for decoding tuples. * They should go out from this file. **********************************************************************/ static int decode_tuples(tuple, buflen) u_int8_t *tuple; int buflen; { u_int8_t *tp = tuple; if (CISTPL_LINKTARGET != *tuple) { DPRINTF(("WRONG TUPLE\n")); return 0; } while (NULL != (tp = decode_tuple(tp))) { if (tuple + buflen < tp) { break; } } return 1; } static u_int8_t * decode_tuple(tuple) u_int8_t *tuple; { u_int8_t type; u_int8_t len; int i; type = tuple[0]; len = tuple[1] + 2; printf("tuple: %s len %d\n", tuple_name(type), len); if (CISTPL_END == type) { return NULL; } for (i = 0; i < len; ++i) { if (i % 16 == 0) { printf(" 0x%2x:", i); } printf(" %x",tuple[i]); if (i % 16 == 15) { printf("\n"); } } if (i % 16 != 0) { printf("\n"); } return tuple + len; } static char * tuple_name(type) int type; { static char *tuple_name_s [] = { "TPL_NULL", "TPL_DEVICE", "Reserved", "Reserved", /* 0-3 */ "CONFIG_CB", "CFTABLE_ENTRY_CB", "Reserved", "BAR", /* 4-7 */ "Reserved", "Reserved", "Reserved", "Reserved", /* 8-B */ "Reserved", "Reserved", "Reserved", "Reserved", /* C-F */ "CHECKSUM", "LONGLINK_A", "LONGLINK_C", "LINKTARGET", /* 10-13 */ "NO_LINK", "VERS_1", "ALTSTR", "DEVICE_A", "JEDEC_C", "JEDEC_A", "CONFIG", "CFTABLE_ENTRY", "DEVICE_OC", "DEVICE_OA", "DEVICE_GEO", "DEVICE_GEO_A", "MANFID", "FUNCID", "FUNCE", "SWIL", /* 20-23 */ "Reserved", "Reserved", "Reserved", "Reserved", /* 24-27 */ "Reserved", "Reserved", "Reserved", "Reserved", /* 28-2B */ "Reserved", "Reserved", "Reserved", "Reserved", /* 2C-2F */ "Reserved", "Reserved", "Reserved", "Reserved", /* 30-33 */ "Reserved", "Reserved", "Reserved", "Reserved", /* 34-37 */ "Reserved", "Reserved", "Reserved", "Reserved", /* 38-3B */ "Reserved", "Reserved", "Reserved", "Reserved", /* 3C-3F */ "VERS_2", "FORMAT", "GEOMETRY", "BYTEORDER", "DATE", "BATTERY", "ORG" }; #define NAME_LEN(x) (sizeof x / sizeof(x[0])) if (type > 0 && type < NAME_LEN(tuple_name_s)) { return tuple_name_s[type]; } else if (0xff == type) { return "END"; } else { return "Reserved"; } }