Home | History | Annotate | Line # | Download | only in cardbus
cardbus.c revision 1.9
      1  1.9      haya /*	$NetBSD: cardbus.c,v 1.9 1999/11/01 09:59:23 haya Exp $	*/
      2  1.1      haya 
      3  1.1      haya /*
      4  1.4      haya  * Copyright (c) 1997, 1998 and 1999
      5  1.4      haya  *     HAYAKAWA Koichi.  All rights reserved.
      6  1.1      haya  *
      7  1.1      haya  * Redistribution and use in source and binary forms, with or without
      8  1.1      haya  * modification, are permitted provided that the following conditions
      9  1.1      haya  * are met:
     10  1.1      haya  * 1. Redistributions of source code must retain the above copyright
     11  1.1      haya  *    notice, this list of conditions and the following disclaimer.
     12  1.1      haya  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1      haya  *    notice, this list of conditions and the following disclaimer in the
     14  1.1      haya  *    documentation and/or other materials provided with the distribution.
     15  1.1      haya  * 3. All advertising materials mentioning features or use of this software
     16  1.1      haya  *    must display the following acknowledgement:
     17  1.1      haya  *	This product includes software developed by HAYAKAWA Koichi.
     18  1.1      haya  * 4. The name of the author may not be used to endorse or promote products
     19  1.1      haya  *    derived from this software without specific prior written permission.
     20  1.1      haya  *
     21  1.1      haya  *
     22  1.1      haya  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     23  1.1      haya  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     24  1.1      haya  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     25  1.1      haya  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     26  1.1      haya  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     27  1.1      haya  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     28  1.1      haya  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     29  1.1      haya  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     30  1.1      haya  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     31  1.1      haya  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     32  1.1      haya  * POSSIBILITY OF SUCH DAMAGE.
     33  1.1      haya  */
     34  1.1      haya 
     35  1.4      haya #include "opt_cardbus.h"
     36  1.1      haya 
     37  1.1      haya #include <sys/types.h>
     38  1.1      haya #include <sys/param.h>
     39  1.1      haya #include <sys/systm.h>
     40  1.1      haya #include <sys/device.h>
     41  1.1      haya #include <sys/malloc.h>
     42  1.1      haya #include <sys/kernel.h>
     43  1.1      haya #include <sys/syslog.h>
     44  1.1      haya 
     45  1.1      haya #include <machine/bus.h>
     46  1.1      haya 
     47  1.1      haya #include <dev/cardbus/cardbusvar.h>
     48  1.1      haya #include <dev/cardbus/pccardcis.h>
     49  1.1      haya 
     50  1.7      joda #include <dev/cardbus/cardbus_exrom.h>
     51  1.7      joda 
     52  1.1      haya #include <dev/pci/pcivar.h>	/* XXX */
     53  1.1      haya #include <dev/pci/pcireg.h>	/* XXX */
     54  1.1      haya 
     55  1.1      haya #if defined CARDBUS_DEBUG
     56  1.1      haya #define STATIC
     57  1.1      haya #define DPRINTF(a) printf a
     58  1.1      haya #define DDELAY(x) delay((x)*1000*1000)
     59  1.1      haya #else
     60  1.1      haya #define STATIC static
     61  1.1      haya #define DPRINTF(a)
     62  1.1      haya #endif
     63  1.1      haya 
     64  1.1      haya 
     65  1.1      haya 
     66  1.1      haya STATIC void cardbusattach __P((struct device *, struct device *, void *));
     67  1.1      haya /* STATIC int cardbusprint __P((void *, const char *)); */
     68  1.1      haya int cardbus_attach_card __P((struct cardbus_softc *));
     69  1.1      haya 
     70  1.1      haya #if !defined __BROKEN_INDIRECT_CONFIG
     71  1.1      haya STATIC int cardbusmatch __P((struct device *, struct cfdata *, void *));
     72  1.1      haya static int cardbussubmatch __P((struct device *, struct cfdata *, void *));
     73  1.1      haya #else
     74  1.1      haya STATIC int cardbusmatch __P((struct device *, void *, void *));
     75  1.1      haya static int cardbussubmatch __P((struct device *, void *, void *));
     76  1.1      haya #endif
     77  1.1      haya static int cardbusprint __P((void *, const char *));
     78  1.1      haya 
     79  1.1      haya static int decode_tuples __P((u_int8_t *, int));
     80  1.1      haya 
     81  1.7      joda static int cardbus_read_tuples __P((struct cardbus_attach_args *,
     82  1.7      joda 				    cardbusreg_t, u_int8_t *, size_t));
     83  1.7      joda 
     84  1.8      joda static void enable_function __P((struct cardbus_softc *, int, int));
     85  1.8      joda static void disable_function __P((struct cardbus_softc *, int));
     86  1.8      joda 
     87  1.1      haya 
     88  1.1      haya struct cfattach cardbus_ca = {
     89  1.1      haya 	sizeof(struct cardbus_softc), cardbusmatch, cardbusattach
     90  1.1      haya };
     91  1.1      haya 
     92  1.1      haya #ifndef __NetBSD_Version__
     93  1.1      haya struct cfdriver cardbus_cd = {
     94  1.1      haya 	NULL, "cardbus", DV_DULL
     95  1.1      haya };
     96  1.1      haya #endif
     97  1.1      haya 
     98  1.1      haya 
     99  1.1      haya STATIC int
    100  1.1      haya #if defined __BROKEN_INDIRECT_CONFIG
    101  1.1      haya cardbusmatch(parent, match, aux)
    102  1.1      haya      struct device *parent;
    103  1.1      haya      void *match;
    104  1.1      haya      void *aux;
    105  1.1      haya #else
    106  1.1      haya cardbusmatch(parent, cf, aux)
    107  1.1      haya      struct device *parent;
    108  1.1      haya      struct cfdata *cf;
    109  1.1      haya      void *aux;
    110  1.1      haya #endif
    111  1.1      haya {
    112  1.1      haya #if defined __BROKEN_INDIRECT_CONFIG
    113  1.1      haya   struct cfdata *cf = match;
    114  1.1      haya #endif
    115  1.1      haya   struct cbslot_attach_args *cba = aux;
    116  1.1      haya 
    117  1.1      haya   if (strcmp(cba->cba_busname, cf->cf_driver->cd_name)) {
    118  1.1      haya     DPRINTF(("cardbusmatch: busname differs %s <=> %s\n",
    119  1.1      haya 	     cba->cba_busname, cf->cf_driver->cd_name));
    120  1.1      haya     return 0;
    121  1.1      haya   }
    122  1.1      haya 
    123  1.6      haya #if 0
    124  1.1      haya   /* which function? */
    125  1.1      haya   if (cf->cbslotcf_func != CBSLOT_UNK_FUNC &&
    126  1.1      haya       cf->cbslotcf_func != cba->cba_function) {
    127  1.6      haya     DPRINTF(("cardbusmatch: function differs %d <=> %d\n",
    128  1.1      haya 	     cf->cbslotcf_func, cba->cba_function));
    129  1.1      haya     return 0;
    130  1.1      haya   }
    131  1.6      haya #endif
    132  1.1      haya 
    133  1.1      haya   if (cba->cba_function < 0 || cba->cba_function > 255) {
    134  1.1      haya     return 0;
    135  1.1      haya   }
    136  1.1      haya 
    137  1.1      haya   return 1;
    138  1.1      haya }
    139  1.1      haya 
    140  1.1      haya 
    141  1.1      haya 
    142  1.1      haya STATIC void
    143  1.1      haya cardbusattach(parent, self, aux)
    144  1.1      haya      struct device *parent;
    145  1.1      haya      struct device *self;
    146  1.1      haya      void *aux;
    147  1.1      haya {
    148  1.1      haya   struct cardbus_softc *sc = (void *)self;
    149  1.1      haya   struct cbslot_attach_args *cba = aux;
    150  1.1      haya   int cdstatus;
    151  1.1      haya 
    152  1.1      haya   sc->sc_bus = cba->cba_bus;
    153  1.1      haya   sc->sc_device = cba->cba_function;
    154  1.1      haya   sc->sc_intrline = cba->cba_intrline;
    155  1.1      haya   sc->sc_cacheline = cba->cba_cacheline;
    156  1.1      haya   sc->sc_lattimer = cba->cba_lattimer;
    157  1.1      haya 
    158  1.3  augustss   printf(": bus %d device %d", sc->sc_bus, sc->sc_device);
    159  1.3  augustss   printf(" cacheline 0x%x, lattimer 0x%x\n", sc->sc_cacheline,sc->sc_lattimer);
    160  1.1      haya 
    161  1.1      haya   sc->sc_iot = cba->cba_iot;	/* CardBus I/O space tag */
    162  1.1      haya   sc->sc_memt = cba->cba_memt;	/* CardBus MEM space tag */
    163  1.1      haya   sc->sc_dmat = cba->cba_dmat;	/* DMA tag */
    164  1.1      haya   sc->sc_cc = cba->cba_cc;
    165  1.1      haya   sc->sc_cf = cba->cba_cf;
    166  1.1      haya 
    167  1.1      haya #if rbus
    168  1.1      haya   sc->sc_rbus_iot = cba->cba_rbus_iot;
    169  1.1      haya   sc->sc_rbus_memt = cba->cba_rbus_memt;
    170  1.1      haya #endif
    171  1.1      haya 
    172  1.1      haya   sc->sc_funcs = NULL;
    173  1.1      haya 
    174  1.1      haya   cdstatus = 0;
    175  1.1      haya }
    176  1.1      haya 
    177  1.7      joda static int
    178  1.7      joda cardbus_read_tuples(ca, cis_ptr, tuples, len)
    179  1.7      joda      struct cardbus_attach_args *ca;
    180  1.7      joda      cardbusreg_t cis_ptr;
    181  1.7      joda      u_int8_t *tuples;
    182  1.7      joda      size_t len;
    183  1.7      joda {
    184  1.8      joda     struct cardbus_softc *sc = ca->ca_ct->ct_sc;
    185  1.7      joda     cardbus_chipset_tag_t cc = ca->ca_ct->ct_cc;
    186  1.7      joda     cardbus_function_tag_t cf = ca->ca_ct->ct_cf;
    187  1.7      joda     cardbustag_t tag = ca->ca_tag;
    188  1.7      joda     cardbusreg_t command;
    189  1.7      joda     int found = 0;
    190  1.7      joda 
    191  1.7      joda     int i, j;
    192  1.7      joda     int cardbus_space = cis_ptr & CARDBUS_CIS_ASIMASK;
    193  1.7      joda     bus_space_handle_t bar_memh;
    194  1.7      joda     bus_size_t bar_size;
    195  1.7      joda     bus_addr_t bar_addr;
    196  1.7      joda 
    197  1.7      joda     int reg;
    198  1.7      joda 
    199  1.7      joda     memset(tuples, 0, len);
    200  1.7      joda 
    201  1.7      joda     cis_ptr = cis_ptr & CARDBUS_CIS_ADDRMASK;
    202  1.7      joda 
    203  1.7      joda     switch(cardbus_space) {
    204  1.7      joda     case CARDBUS_CIS_ASI_TUPLE:
    205  1.8      joda 	DPRINTF(("%s: reading CIS data from configuration space\n",
    206  1.8      joda 		 sc->sc_dev.dv_xname));
    207  1.7      joda 	for (i = cis_ptr, j = 0; i < 0xff; i += 4) {
    208  1.7      joda 	    u_int32_t e = (cf->cardbus_conf_read)(cc, tag, i);
    209  1.7      joda 	    tuples[j] = 0xff & e;
    210  1.7      joda 	    e >>= 8;
    211  1.7      joda 	    tuples[j + 1] = 0xff & e;
    212  1.7      joda 	    e >>= 8;
    213  1.7      joda 	    tuples[j + 2] = 0xff & e;
    214  1.7      joda 	    e >>= 8;
    215  1.7      joda 	    tuples[j + 3] = 0xff & e;
    216  1.7      joda 	    j += 4;
    217  1.7      joda 	}
    218  1.7      joda 	found++;
    219  1.7      joda 	break;
    220  1.1      haya 
    221  1.7      joda     case CARDBUS_CIS_ASI_BAR0:
    222  1.7      joda     case CARDBUS_CIS_ASI_BAR1:
    223  1.7      joda     case CARDBUS_CIS_ASI_BAR2:
    224  1.7      joda     case CARDBUS_CIS_ASI_BAR3:
    225  1.7      joda     case CARDBUS_CIS_ASI_BAR4:
    226  1.7      joda     case CARDBUS_CIS_ASI_BAR5:
    227  1.7      joda     case CARDBUS_CIS_ASI_ROM:
    228  1.7      joda 	if(cardbus_space == CARDBUS_CIS_ASI_ROM) {
    229  1.7      joda 	    reg = CARDBUS_ROM_REG;
    230  1.8      joda 	    DPRINTF(("%s: reading CIS data from ROM\n",
    231  1.8      joda 		     sc->sc_dev.dv_xname));
    232  1.7      joda 	} else {
    233  1.7      joda 	    reg = CARDBUS_BASE0_REG + (cardbus_space - 1) * 4;
    234  1.7      joda 	    DPRINTF(("%s: reading CIS data from BAR%d\n",
    235  1.8      joda 		     sc->sc_dev.dv_xname, cardbus_space - 1));
    236  1.7      joda 	}
    237  1.7      joda 
    238  1.7      joda 	/* XXX zero register so mapreg_map doesn't get confused by old
    239  1.7      joda            contents */
    240  1.7      joda 	cardbus_conf_write(cc, cf, tag, reg, 0);
    241  1.7      joda 	if(Cardbus_mapreg_map(ca->ca_ct, reg,
    242  1.7      joda 			      CARDBUS_MAPREG_TYPE_MEM | PCI_MAPREG_MEM_TYPE_32BIT,
    243  1.7      joda 			      0,
    244  1.7      joda 			      NULL, &bar_memh, &bar_addr, &bar_size)) {
    245  1.8      joda 	    printf("%s: failed to map memory\n", sc->sc_dev.dv_xname);
    246  1.7      joda 	    return 1;
    247  1.7      joda 	}
    248  1.7      joda 
    249  1.7      joda 
    250  1.7      joda 	if(cardbus_space == CARDBUS_CIS_ASI_ROM) {
    251  1.7      joda 	    cardbusreg_t exrom;
    252  1.7      joda 	    int save;
    253  1.7      joda 	    struct cardbus_rom_image_head rom_image;
    254  1.7      joda 	    struct cardbus_rom_image *p;
    255  1.7      joda 
    256  1.7      joda 	    save = splhigh();
    257  1.7      joda 	    /* enable rom address decoder */
    258  1.7      joda 	    exrom = cardbus_conf_read(cc, cf, tag, reg);
    259  1.7      joda 	    cardbus_conf_write(cc, cf, tag, reg, exrom | 1);
    260  1.7      joda 
    261  1.7      joda 	    command = cardbus_conf_read(cc, cf, tag, CARDBUS_COMMAND_STATUS_REG);
    262  1.7      joda 	    cardbus_conf_write(cc, cf, tag, CARDBUS_COMMAND_STATUS_REG,
    263  1.7      joda 			       command | CARDBUS_COMMAND_MEM_ENABLE);
    264  1.7      joda 
    265  1.7      joda 	    printf("reg = %x\n", reg);
    266  1.7      joda 	    printf("bar_addr = %lx, exrom = %x\n", bar_addr, exrom);
    267  1.7      joda 	    printf("exrom = %x\n", cardbus_conf_read(cc, cf, tag, reg));
    268  1.7      joda 
    269  1.7      joda 	    if(cardbus_read_exrom(ca->ca_memt, bar_memh, &rom_image))
    270  1.7      joda 		goto out;
    271  1.7      joda 
    272  1.7      joda 	    for(p = SIMPLEQ_FIRST(&rom_image);
    273  1.7      joda 		p;
    274  1.7      joda 		p = SIMPLEQ_NEXT(p, next)) {
    275  1.7      joda 		if(p->rom_image == CARDBUS_CIS_ASI_ROM_IMAGE(cis_ptr)) {
    276  1.7      joda 		    bus_space_read_region_1(p->romt, p->romh,
    277  1.7      joda 					    CARDBUS_CIS_ADDR(cis_ptr),
    278  1.7      joda 					    tuples, 256);
    279  1.7      joda 		    found++;
    280  1.7      joda 		}
    281  1.7      joda 		break;
    282  1.7      joda 	    }
    283  1.7      joda 	    while((p = SIMPLEQ_FIRST(&rom_image)) != NULL) {
    284  1.7      joda 		SIMPLEQ_REMOVE_HEAD(&rom_image, p, next);
    285  1.7      joda 		free(p, M_DEVBUF);
    286  1.7      joda 	    }
    287  1.7      joda 	out:
    288  1.7      joda 	    exrom = cardbus_conf_read(cc, cf, tag, reg);
    289  1.7      joda 	    cardbus_conf_write(cc, cf, tag, reg, exrom & ~1);
    290  1.7      joda 	    splx(save);
    291  1.7      joda 	} else {
    292  1.7      joda 	    command = cardbus_conf_read(cc, cf, tag, CARDBUS_COMMAND_STATUS_REG);
    293  1.7      joda 	    cardbus_conf_write(cc, cf, tag, CARDBUS_COMMAND_STATUS_REG,
    294  1.7      joda 			       command | CARDBUS_COMMAND_MEM_ENABLE);
    295  1.7      joda 	    /* XXX byte order? */
    296  1.7      joda 	    bus_space_read_region_1(ca->ca_memt, bar_memh,
    297  1.7      joda 				    cis_ptr, tuples, 256);
    298  1.7      joda 	    found++;
    299  1.7      joda 	}
    300  1.7      joda 	command = cardbus_conf_read(cc, cf, tag, CARDBUS_COMMAND_STATUS_REG);
    301  1.7      joda 	cardbus_conf_write(cc, cf, tag, CARDBUS_COMMAND_STATUS_REG,
    302  1.7      joda 			   command & ~CARDBUS_COMMAND_MEM_ENABLE);
    303  1.7      joda 	cardbus_conf_write(cc, cf, tag, reg, 0);
    304  1.7      joda #if 0
    305  1.7      joda 	/* XXX unmap memory */
    306  1.7      joda 	(*ca->ca_ct->ct_cf->cardbus_space_free)(ca->ca_ct,
    307  1.7      joda 						ca->ca_ct->ct_sc->sc_rbus_memt,
    308  1.7      joda 						bar_memh, bar_size);
    309  1.7      joda #endif
    310  1.7      joda 	break;
    311  1.1      haya 
    312  1.7      joda #ifdef DIAGNOSTIC
    313  1.7      joda     default:
    314  1.8      joda 	panic("%s: bad CIS space (%d)", sc->sc_dev.dv_xname, cardbus_space);
    315  1.7      joda #endif
    316  1.7      joda     }
    317  1.7      joda     return !found;
    318  1.7      joda }
    319  1.1      haya 
    320  1.1      haya /*
    321  1.1      haya  * int cardbus_attach_card(struct cardbus_softc *sc)
    322  1.1      haya  *
    323  1.1      haya  *    This function attaches the card on the slot: turns on power,
    324  1.1      haya  *    reads and analyses tuple, sets consifuration index.
    325  1.1      haya  *
    326  1.1      haya  *    This function returns the number of recognised device functions.
    327  1.1      haya  *    If no functions are recognised, return 0.
    328  1.1      haya  */
    329  1.1      haya int
    330  1.1      haya cardbus_attach_card(sc)
    331  1.1      haya      struct cardbus_softc *sc;
    332  1.1      haya {
    333  1.1      haya   cardbus_chipset_tag_t cc;
    334  1.1      haya   cardbus_function_tag_t cf;
    335  1.1      haya   int cdstatus;
    336  1.1      haya   cardbustag_t tag;
    337  1.1      haya   cardbusreg_t id, class, cis_ptr;
    338  1.1      haya   cardbusreg_t bhlc;
    339  1.1      haya   u_int8_t tuple[2048];
    340  1.1      haya   int function, nfunction;
    341  1.1      haya   struct cardbus_devfunc **previous_next = &(sc->sc_funcs);
    342  1.1      haya   struct device *csc;
    343  1.1      haya   int no_work_funcs = 0;
    344  1.1      haya   cardbus_devfunc_t ct;
    345  1.1      haya 
    346  1.1      haya   cc = sc->sc_cc;
    347  1.1      haya   cf = sc->sc_cf;
    348  1.1      haya 
    349  1.1      haya   DPRINTF(("cardbus_attach_card: cb%d start\n", sc->sc_dev.dv_unit));
    350  1.1      haya 
    351  1.1      haya   /* inspect initial voltage */
    352  1.1      haya   if (0 == (cdstatus = (cf->cardbus_ctrl)(cc, CARDBUS_CD))) {
    353  1.1      haya     DPRINTF(("cardbusattach: no CardBus card on cb%d\n", sc->sc_dev.dv_unit));
    354  1.1      haya     return 0;
    355  1.1      haya   }
    356  1.1      haya 
    357  1.8      joda   enable_function(sc, cdstatus, 8); /* XXX use fake function 8 to
    358  1.8      joda 				       keep power on during whole
    359  1.8      joda 				       configuration */
    360  1.1      haya   function = 0;
    361  1.1      haya 
    362  1.1      haya   tag = cardbus_make_tag(cc, cf, sc->sc_bus, sc->sc_device, function);
    363  1.1      haya 
    364  1.1      haya   /*
    365  1.1      haya    * Wait until power comes up.  Maxmum 500 ms.
    366  1.1      haya    */
    367  1.1      haya   {
    368  1.1      haya     int i;
    369  1.1      haya     for (i = 0; i < 5; ++i) {
    370  1.1      haya       id = cardbus_conf_read(cc, cf, tag, CARDBUS_ID_REG);
    371  1.1      haya       if (id != 0xffffffff && id != 0) {
    372  1.1      haya 	break;
    373  1.1      haya       }
    374  1.1      haya       delay(100*1000);		/* or tsleep */
    375  1.1      haya     }
    376  1.1      haya     if (i == 5) {
    377  1.1      haya       return 0;
    378  1.1      haya     }
    379  1.1      haya   }
    380  1.1      haya 
    381  1.1      haya   bhlc = cardbus_conf_read(cc, cf, tag, CARDBUS_BHLC_REG);
    382  1.1      haya   if (CARDBUS_LATTIMER(bhlc) < 0x10) {
    383  1.5      joda     bhlc &= ~(CARDBUS_LATTIMER_MASK << CARDBUS_LATTIMER_SHIFT);
    384  1.1      haya     bhlc |= (0x10 << CARDBUS_LATTIMER_SHIFT);
    385  1.1      haya     cardbus_conf_write(cc, cf, tag, CARDBUS_BHLC_REG, bhlc);
    386  1.1      haya   }
    387  1.1      haya 
    388  1.1      haya   nfunction = CARDBUS_HDRTYPE_MULTIFN(bhlc) ? 8 : 1;
    389  1.1      haya 
    390  1.8      joda   for(function = 0; function < nfunction; function++) {
    391  1.8      joda       struct cardbus_attach_args ca;
    392  1.8      joda 
    393  1.8      joda       tag = cardbus_make_tag(cc, cf, sc->sc_bus, sc->sc_device, function);
    394  1.8      joda 
    395  1.8      joda       id = cardbus_conf_read(cc, cf, tag, CARDBUS_ID_REG);
    396  1.8      joda       class = cardbus_conf_read(cc, cf, tag, CARDBUS_CLASS_REG);
    397  1.8      joda       cis_ptr = cardbus_conf_read(cc, cf, tag, CARDBUS_CIS_REG);
    398  1.8      joda 
    399  1.8      joda       /* Invalid vendor ID value? */
    400  1.8      joda       if (CARDBUS_VENDOR(id) == 0xffff)
    401  1.8      joda 	  continue;
    402  1.8      joda 
    403  1.8      joda       DPRINTF(("cardbus_attach_card: Vendor 0x%x, Product 0x%x, CIS 0x%x\n",
    404  1.8      joda 	       CARDBUS_VENDOR(id), CARDBUS_PRODUCT(id), cis_ptr));
    405  1.8      joda 
    406  1.8      joda       enable_function(sc, cdstatus, function);
    407  1.1      haya 
    408  1.8      joda       /* we need to allocate the ct here, since we might
    409  1.8      joda 	 need it when reading the CIS */
    410  1.8      joda       if (NULL == (ct = (cardbus_devfunc_t)malloc(sizeof(struct cardbus_devfunc),
    411  1.8      joda 						  M_DEVBUF, M_NOWAIT))) {
    412  1.8      joda 	  panic("no room for cardbus_tag");
    413  1.8      joda       }
    414  1.1      haya 
    415  1.8      joda       ct->ct_cc = sc->sc_cc;
    416  1.8      joda       ct->ct_cf = sc->sc_cf;
    417  1.8      joda       ct->ct_bus = sc->sc_bus;
    418  1.8      joda       ct->ct_dev = sc->sc_device;
    419  1.8      joda       ct->ct_func = function;
    420  1.8      joda       ct->ct_sc = sc;
    421  1.8      joda       ct->ct_next = NULL;
    422  1.8      joda       *previous_next = ct;
    423  1.8      joda 
    424  1.8      joda       ca.ca_unit = sc->sc_dev.dv_unit;
    425  1.8      joda       ca.ca_ct = ct;
    426  1.8      joda 
    427  1.8      joda       ca.ca_iot = sc->sc_iot;
    428  1.8      joda       ca.ca_memt = sc->sc_memt;
    429  1.8      joda       ca.ca_dmat = sc->sc_dmat;
    430  1.8      joda 
    431  1.8      joda       ca.ca_tag = tag;
    432  1.8      joda       ca.ca_device = sc->sc_device;
    433  1.8      joda       ca.ca_function = function;
    434  1.8      joda       ca.ca_id = id;
    435  1.8      joda       ca.ca_class = class;
    436  1.8      joda 
    437  1.8      joda       ca.ca_intrline = sc->sc_intrline;
    438  1.8      joda 
    439  1.8      joda       bzero(tuple, 2048);
    440  1.8      joda 
    441  1.8      joda       if(cardbus_read_tuples(&ca, cis_ptr, tuple, sizeof(tuple))) {
    442  1.8      joda 	  printf("cardbus_attach_card: failed to read CIS\n");
    443  1.8      joda 	  free(ct, M_DEVBUF);
    444  1.8      joda 	  disable_function(sc, function);
    445  1.8      joda 	  continue;
    446  1.8      joda       }
    447  1.7      joda 
    448  1.8      joda       decode_tuples(tuple, 2048);
    449  1.7      joda 
    450  1.7      joda 
    451  1.8      joda       if (NULL == (csc = config_found_sm((void *)sc, &ca, cardbusprint, cardbussubmatch))) {
    452  1.8      joda 	  /* do not match */
    453  1.8      joda 	  disable_function(sc, function);
    454  1.8      joda 	  free(ct, M_DEVBUF);
    455  1.8      joda 	  *previous_next = NULL;
    456  1.8      joda       } else {
    457  1.8      joda 	  /* found */
    458  1.8      joda 	  previous_next = &(ct->ct_next);
    459  1.8      joda 	  ct->ct_device = csc;
    460  1.8      joda 	  ++no_work_funcs;
    461  1.8      joda       }
    462  1.1      haya   }
    463  1.8      joda   /* XXX power down pseudo function 8 (this will power down the card
    464  1.8      joda      if no functions were attached) */
    465  1.8      joda   disable_function(sc, 8);
    466  1.1      haya 
    467  1.8      joda   if(no_work_funcs == 0)
    468  1.8      joda       free(cc, M_DEVBUF);
    469  1.1      haya   return no_work_funcs;
    470  1.1      haya }
    471  1.1      haya 
    472  1.1      haya 
    473  1.1      haya static int
    474  1.1      haya #ifdef __BROKEN_INDIRECT_CONFIG
    475  1.1      haya cardbussubmatch(parent, match, aux)
    476  1.1      haya #else
    477  1.1      haya cardbussubmatch(parent, cf, aux)
    478  1.1      haya #endif
    479  1.1      haya      struct device *parent;
    480  1.1      haya #ifdef __BROKEN_INDIRECT_CONFIG
    481  1.1      haya      void *match;
    482  1.1      haya #else
    483  1.1      haya      struct cfdata *cf;
    484  1.1      haya #endif
    485  1.1      haya      void *aux;
    486  1.1      haya {
    487  1.1      haya #ifdef __BROKEN_INDIRECT_CONFIG
    488  1.1      haya   struct cfdata *cf = match;
    489  1.1      haya #endif
    490  1.1      haya   struct cardbus_attach_args *ca = aux;
    491  1.1      haya 
    492  1.1      haya   if (cf->cardbuscf_dev != CARDBUS_UNK_DEV &&
    493  1.1      haya       cf->cardbuscf_dev != ca->ca_unit) {
    494  1.1      haya     return 0;
    495  1.1      haya   }
    496  1.1      haya   if (cf->cardbuscf_function != CARDBUS_UNK_FUNCTION &&
    497  1.1      haya       cf->cardbuscf_function != ca->ca_function) {
    498  1.1      haya     return 0;
    499  1.1      haya   }
    500  1.1      haya 
    501  1.1      haya   return ((*cf->cf_attach->ca_match)(parent, cf, aux));
    502  1.1      haya }
    503  1.1      haya 
    504  1.1      haya 
    505  1.1      haya 
    506  1.1      haya static int
    507  1.1      haya cardbusprint(aux, pnp)
    508  1.1      haya      void *aux;
    509  1.1      haya      const char *pnp;
    510  1.1      haya {
    511  1.1      haya   register struct cardbus_attach_args *ca = aux;
    512  1.1      haya   char devinfo[256];
    513  1.1      haya 
    514  1.1      haya   if (pnp) {
    515  1.1      haya     pci_devinfo(ca->ca_id, ca->ca_class, 1, devinfo);
    516  1.1      haya     printf("%s at %s", devinfo, pnp);
    517  1.1      haya   }
    518  1.1      haya   printf(" dev %d function %d", ca->ca_device, ca->ca_function);
    519  1.1      haya 
    520  1.1      haya   return UNCONF;
    521  1.1      haya }
    522  1.1      haya 
    523  1.1      haya 
    524  1.1      haya 
    525  1.1      haya 
    526  1.1      haya 
    527  1.1      haya 
    528  1.1      haya /*
    529  1.1      haya  * void *cardbus_intr_establish(cc, cf, irq, level, func, arg)
    530  1.1      haya  *   Interrupt handler of pccard.
    531  1.1      haya  *  args:
    532  1.1      haya  *   cardbus_chipset_tag_t *cc
    533  1.1      haya  *   int irq:
    534  1.1      haya  */
    535  1.1      haya void *
    536  1.1      haya cardbus_intr_establish(cc, cf, irq, level, func, arg)
    537  1.1      haya      cardbus_chipset_tag_t cc;
    538  1.1      haya      cardbus_function_tag_t cf;
    539  1.1      haya      cardbus_intr_handle_t irq;
    540  1.1      haya      int level;
    541  1.1      haya      int (*func) __P((void *));
    542  1.1      haya      void *arg;
    543  1.1      haya {
    544  1.1      haya   DPRINTF(("- cardbus_intr_establish: irq %d\n", irq));
    545  1.1      haya 
    546  1.1      haya   return (*cf->cardbus_intr_establish)(cc, irq, level, func, arg);
    547  1.1      haya }
    548  1.1      haya 
    549  1.1      haya 
    550  1.1      haya 
    551  1.1      haya /*
    552  1.1      haya  * void cardbus_intr_disestablish(cc, cf, handler)
    553  1.1      haya  *   Interrupt handler of pccard.
    554  1.1      haya  *  args:
    555  1.1      haya  *   cardbus_chipset_tag_t *cc
    556  1.1      haya  */
    557  1.1      haya void
    558  1.1      haya cardbus_intr_disestablish(cc, cf, handler)
    559  1.1      haya      cardbus_chipset_tag_t cc;
    560  1.1      haya      cardbus_function_tag_t cf;
    561  1.1      haya      void *handler;
    562  1.1      haya {
    563  1.1      haya   DPRINTF(("- pccard_intr_disestablish\n"));
    564  1.1      haya 
    565  1.1      haya  (*cf->cardbus_intr_disestablish)(cc, handler);
    566  1.1      haya   return;
    567  1.1      haya }
    568  1.1      haya 
    569  1.1      haya 
    570  1.1      haya 
    571  1.8      joda /* XXX this should be merged with cardbus_function_{enable,disable},
    572  1.8      joda    but we don't have a ct when these functions are called */
    573  1.8      joda 
    574  1.8      joda static void
    575  1.8      joda enable_function(sc, cdstatus, function)
    576  1.8      joda      struct cardbus_softc *sc;
    577  1.8      joda      int cdstatus;
    578  1.8      joda      int function;
    579  1.8      joda {
    580  1.8      joda     if(sc->sc_poweron_func == 0) {
    581  1.8      joda 	if (cdstatus & CARDBUS_3V_CARD) {
    582  1.8      joda 	    sc->sc_cf->cardbus_power(sc->sc_cc, CARDBUS_VCC_3V);
    583  1.8      joda 	}
    584  1.8      joda 	(sc->sc_cf->cardbus_ctrl)(sc->sc_cc, CARDBUS_RESET);
    585  1.8      joda     }
    586  1.8      joda     sc->sc_poweron_func |= (1 << function);
    587  1.8      joda }
    588  1.8      joda 
    589  1.8      joda static void
    590  1.8      joda disable_function(sc, function)
    591  1.8      joda      struct cardbus_softc *sc;
    592  1.8      joda      int function;
    593  1.8      joda {
    594  1.8      joda     sc->sc_poweron_func &= ~(1 << function);
    595  1.8      joda     if(sc->sc_poweron_func == 0) {
    596  1.8      joda 	/* power-off because no functions are enabled */
    597  1.8      joda 	sc->sc_cf->cardbus_power(sc->sc_cc, CARDBUS_VCC_0V);
    598  1.8      joda     }
    599  1.8      joda }
    600  1.8      joda 
    601  1.1      haya /*
    602  1.9      haya  * int cardbus_function_enable(struct cardbus_softc *sc, int func)
    603  1.1      haya  *
    604  1.1      haya  *   This function enables a function on a card.  When no power is
    605  1.1      haya  *  applied on the card, power will be applied on it.
    606  1.1      haya  */
    607  1.1      haya int
    608  1.9      haya cardbus_function_enable(sc, func)
    609  1.9      haya      struct cardbus_softc *sc;
    610  1.9      haya      int func;
    611  1.1      haya {
    612  1.1      haya   cardbus_chipset_tag_t cc = sc->sc_cc;
    613  1.1      haya   cardbus_function_tag_t cf = sc->sc_cf;
    614  1.1      haya   cardbusreg_t command;
    615  1.1      haya   cardbustag_t tag;
    616  1.1      haya 
    617  1.1      haya   DPRINTF(("entering cardbus_function_enable...  "));
    618  1.1      haya 
    619  1.1      haya   /* entering critical area */
    620  1.1      haya 
    621  1.8      joda   enable_function(sc, CARDBUS_3V_CARD, func); /* XXX: sc_vold should be used */
    622  1.1      haya 
    623  1.1      haya   /* exiting critical area */
    624  1.1      haya 
    625  1.9      haya   tag = cardbus_make_tag(cc, cf, sc->sc_bus, sc->sc_device, func);
    626  1.9      haya 
    627  1.1      haya   command = cardbus_conf_read(cc, cf, tag, CARDBUS_COMMAND_STATUS_REG);
    628  1.1      haya   command |= (CARDBUS_COMMAND_MEM_ENABLE | CARDBUS_COMMAND_IO_ENABLE | CARDBUS_COMMAND_MASTER_ENABLE); /* XXX: good guess needed */
    629  1.9      haya 
    630  1.1      haya   cardbus_conf_write(cc, cf, tag, CARDBUS_COMMAND_STATUS_REG, command);
    631  1.1      haya 
    632  1.9      haya   cardbus_free_tag(cc, cf, tag);
    633  1.1      haya 
    634  1.1      haya   DPRINTF(("%x\n", sc->sc_poweron_func));
    635  1.1      haya 
    636  1.1      haya   return 0;
    637  1.1      haya }
    638  1.1      haya 
    639  1.1      haya 
    640  1.1      haya /*
    641  1.9      haya  * int cardbus_function_disable(struct cardbus_softc *, int func)
    642  1.1      haya  *
    643  1.1      haya  *   This function disable a function on a card.  When no functions are
    644  1.1      haya  *  enabled, it turns off the power.
    645  1.1      haya  */
    646  1.1      haya int
    647  1.9      haya cardbus_function_disable(sc, func)
    648  1.9      haya      struct cardbus_softc *sc;
    649  1.9      haya      int func;
    650  1.1      haya {
    651  1.1      haya 
    652  1.9      haya   DPRINTF(("entering cardbus_function_disable...  "));
    653  1.1      haya 
    654  1.8      joda   disable_function(sc, func);
    655  1.1      haya 
    656  1.1      haya   return 0;
    657  1.1      haya }
    658  1.1      haya 
    659  1.1      haya 
    660  1.1      haya 
    661  1.1      haya 
    662  1.1      haya 
    663  1.1      haya 
    664  1.1      haya 
    665  1.1      haya /*
    666  1.1      haya  * below this line, there are some functions for decoding tuples.
    667  1.1      haya  * They should go out from this file.
    668  1.1      haya  */
    669  1.1      haya 
    670  1.1      haya static u_int8_t *decode_tuple __P((u_int8_t *));
    671  1.3  augustss #ifdef CARDBUS_DEBUG
    672  1.1      haya static char *tuple_name __P((int));
    673  1.3  augustss #endif
    674  1.1      haya 
    675  1.1      haya static int
    676  1.1      haya decode_tuples(tuple, buflen)
    677  1.1      haya      u_int8_t *tuple;
    678  1.1      haya      int buflen;
    679  1.1      haya {
    680  1.1      haya   u_int8_t *tp = tuple;
    681  1.1      haya 
    682  1.1      haya   if (CISTPL_LINKTARGET != *tuple) {
    683  1.1      haya     DPRINTF(("WRONG TUPLE: 0x%x\n", *tuple));
    684  1.1      haya     return 0;
    685  1.1      haya   }
    686  1.1      haya 
    687  1.1      haya   while (NULL != (tp = decode_tuple(tp))) {
    688  1.1      haya     if (tuple + buflen < tp) {
    689  1.1      haya       break;
    690  1.1      haya     }
    691  1.1      haya   }
    692  1.1      haya 
    693  1.1      haya   return 1;
    694  1.1      haya }
    695  1.1      haya 
    696  1.1      haya 
    697  1.1      haya static u_int8_t *
    698  1.1      haya decode_tuple(tuple)
    699  1.1      haya      u_int8_t *tuple;
    700  1.1      haya {
    701  1.1      haya   u_int8_t type;
    702  1.1      haya   u_int8_t len;
    703  1.3  augustss #ifdef CARDBUS_DEBUG
    704  1.1      haya   int i;
    705  1.3  augustss #endif
    706  1.1      haya 
    707  1.1      haya   type = tuple[0];
    708  1.1      haya   len = tuple[1] + 2;
    709  1.1      haya 
    710  1.3  augustss #ifdef CARDBUS_DEBUG
    711  1.1      haya   printf("tuple: %s len %d\n", tuple_name(type), len);
    712  1.3  augustss #endif
    713  1.1      haya   if (CISTPL_END == type) {
    714  1.1      haya     return NULL;
    715  1.1      haya   }
    716  1.1      haya 
    717  1.3  augustss #ifdef CARDBUS_DEBUG
    718  1.1      haya   for (i = 0; i < len; ++i) {
    719  1.1      haya     if (i % 16 == 0) {
    720  1.1      haya       printf("  0x%2x:", i);
    721  1.1      haya     }
    722  1.1      haya     printf(" %x",tuple[i]);
    723  1.1      haya     if (i % 16 == 15) {
    724  1.1      haya       printf("\n");
    725  1.1      haya     }
    726  1.1      haya   }
    727  1.1      haya   if (i % 16 != 0) {
    728  1.1      haya     printf("\n");
    729  1.1      haya   }
    730  1.3  augustss #endif
    731  1.1      haya 
    732  1.1      haya   return tuple + len;
    733  1.1      haya }
    734  1.1      haya 
    735  1.1      haya 
    736  1.3  augustss #ifdef CARDBUS_DEBUG
    737  1.1      haya static char *
    738  1.1      haya tuple_name(type)
    739  1.1      haya      int type;
    740  1.1      haya {
    741  1.1      haya   static char *tuple_name_s [] = {
    742  1.1      haya     "TPL_NULL", "TPL_DEVICE", "Reserved", "Reserved", /* 0-3 */
    743  1.1      haya     "CONFIG_CB", "CFTABLE_ENTRY_CB", "Reserved", "BAR", /* 4-7 */
    744  1.1      haya     "Reserved", "Reserved", "Reserved", "Reserved", /* 8-B */
    745  1.1      haya     "Reserved", "Reserved", "Reserved", "Reserved", /* C-F */
    746  1.1      haya     "CHECKSUM", "LONGLINK_A", "LONGLINK_C", "LINKTARGET",	/* 10-13 */
    747  1.1      haya     "NO_LINK", "VERS_1", "ALTSTR", "DEVICE_A",
    748  1.1      haya     "JEDEC_C", "JEDEC_A", "CONFIG", "CFTABLE_ENTRY",
    749  1.1      haya     "DEVICE_OC", "DEVICE_OA", "DEVICE_GEO", "DEVICE_GEO_A",
    750  1.1      haya     "MANFID", "FUNCID", "FUNCE", "SWIL", /* 20-23 */
    751  1.1      haya     "Reserved", "Reserved", "Reserved", "Reserved", /* 24-27 */
    752  1.1      haya     "Reserved", "Reserved", "Reserved", "Reserved", /* 28-2B */
    753  1.1      haya     "Reserved", "Reserved", "Reserved", "Reserved", /* 2C-2F */
    754  1.1      haya     "Reserved", "Reserved", "Reserved", "Reserved", /* 30-33 */
    755  1.1      haya     "Reserved", "Reserved", "Reserved", "Reserved", /* 34-37 */
    756  1.1      haya     "Reserved", "Reserved", "Reserved", "Reserved", /* 38-3B */
    757  1.1      haya     "Reserved", "Reserved", "Reserved", "Reserved", /* 3C-3F */
    758  1.1      haya     "VERS_2", "FORMAT", "GEOMETRY", "BYTEORDER",
    759  1.1      haya     "DATE", "BATTERY", "ORG"
    760  1.1      haya   };
    761  1.1      haya #define NAME_LEN(x) (sizeof x / sizeof(x[0]))
    762  1.1      haya 
    763  1.1      haya   if (type > 0 && type < NAME_LEN(tuple_name_s)) {
    764  1.1      haya     return tuple_name_s[type];
    765  1.1      haya   } else if (0xff == type) {
    766  1.1      haya     return "END";
    767  1.1      haya   } else {
    768  1.1      haya     return "Reserved";
    769  1.1      haya   }
    770  1.1      haya }
    771  1.3  augustss #endif
    772