Home | History | Annotate | Line # | Download | only in cardbus
cardslot.c revision 1.1
      1  1.1  haya /*	$Id: cardslot.c,v 1.1 1999/10/15 06:07:19 haya Exp $ */
      2  1.1  haya 
      3  1.1  haya /*
      4  1.1  haya  * Copyright (c) 1999
      5  1.1  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.1  haya /* #define CARDSLOT_DEBUG */
     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 #include <sys/kthread.h>
     45  1.1  haya 
     46  1.1  haya #include <machine/bus.h>
     47  1.1  haya 
     48  1.1  haya #include <dev/cardbus/cardslotvar.h>
     49  1.1  haya #include <dev/cardbus/cardbusvar.h>
     50  1.1  haya #include <dev/pcmcia/pcmciavar.h>
     51  1.1  haya #include <dev/pcmcia/pcmciachip.h>
     52  1.1  haya #include <dev/ic/i82365var.h>
     53  1.1  haya 
     54  1.1  haya 
     55  1.1  haya #if defined CARDSLOT_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 cardslotattach __P((struct device *, struct device *, void *));
     67  1.1  haya 
     68  1.1  haya #if !defined __BROKEN_INDIRECT_CONFIG
     69  1.1  haya STATIC int cardslotmatch __P((struct device *, struct cfdata *, void *));
     70  1.1  haya #else
     71  1.1  haya STATIC int cardslotmatch __P((struct device *, void *, void *));
     72  1.1  haya #endif
     73  1.1  haya static void create_slot_manager __P((void *));
     74  1.1  haya static void cardslot_event_thread __P((void *arg));
     75  1.1  haya 
     76  1.1  haya STATIC int cardslot_cb_print __P((void *aux, const char *pcic));
     77  1.1  haya static int cardslot_16_print __P((void *, const char *));
     78  1.1  haya static int cardslot_16_submatch __P((struct device *, struct cfdata *,void *));
     79  1.1  haya 
     80  1.1  haya struct cfattach cardslot_ca = {
     81  1.1  haya 	sizeof(struct cardslot_softc), cardslotmatch, cardslotattach
     82  1.1  haya };
     83  1.1  haya 
     84  1.1  haya #ifndef __NetBSD_Version__
     85  1.1  haya struct cfdriver cardslot_cd = {
     86  1.1  haya 	NULL, "cardslot", DV_DULL
     87  1.1  haya };
     88  1.1  haya #endif
     89  1.1  haya 
     90  1.1  haya 
     91  1.1  haya STATIC int
     92  1.1  haya #if defined __BROKEN_INDIRECT_CONFIG
     93  1.1  haya cardslotmatch(parent, match, aux)
     94  1.1  haya      struct device *parent;
     95  1.1  haya      void *match;
     96  1.1  haya      void *aux;
     97  1.1  haya #else
     98  1.1  haya cardslotmatch(parent, cf, aux)
     99  1.1  haya      struct device *parent;
    100  1.1  haya      struct cfdata *cf;
    101  1.1  haya      void *aux;
    102  1.1  haya #endif
    103  1.1  haya {
    104  1.1  haya #if defined __BROKEN_INDIRECT_CONFIG
    105  1.1  haya   struct cfdata *cf = match;
    106  1.1  haya #endif
    107  1.1  haya   struct cardslot_attach_args *caa = aux;
    108  1.1  haya 
    109  1.1  haya   if (caa->caa_cb_attach == NULL && caa->caa_16_attach == NULL) {
    110  1.1  haya     /* Neither CardBus nor 16-bit PCMCIA are defined. */
    111  1.1  haya     return 0;
    112  1.1  haya   }
    113  1.1  haya 
    114  1.1  haya   return 1;
    115  1.1  haya }
    116  1.1  haya 
    117  1.1  haya 
    118  1.1  haya 
    119  1.1  haya STATIC void
    120  1.1  haya cardslotattach(parent, self, aux)
    121  1.1  haya      struct device *parent;
    122  1.1  haya      struct device *self;
    123  1.1  haya      void *aux;
    124  1.1  haya {
    125  1.1  haya   struct cardslot_softc *sc = (struct cardslot_softc *)self;
    126  1.1  haya   struct cardslot_attach_args *caa = aux;
    127  1.1  haya 
    128  1.1  haya   struct cbslot_attach_args *cba = caa->caa_cb_attach;
    129  1.1  haya   struct pcmciabus_attach_args *pa = caa->caa_16_attach;
    130  1.1  haya 
    131  1.1  haya   struct cardbus_softc *csc;
    132  1.1  haya   struct pcmcia_softc *psc;
    133  1.1  haya 
    134  1.1  haya   int card_attach_now;
    135  1.1  haya 
    136  1.1  haya   sc->sc_slot = sc->sc_dev.dv_unit;
    137  1.1  haya   sc->sc_cb_softc = NULL;
    138  1.1  haya   sc->sc_16_softc = NULL;
    139  1.1  haya   SIMPLEQ_INIT(&sc->sc_events);
    140  1.1  haya   sc->sc_th_enable = 0;
    141  1.1  haya 
    142  1.1  haya   printf(" slot %d flags %x\n", sc->sc_slot, sc->sc_dev.dv_cfdata->cf_flags);
    143  1.1  haya 
    144  1.1  haya   DPRINTF(("%s attaching CardBus bus...\n", sc->sc_dev.dv_xname));
    145  1.1  haya   if (cba != NULL) {
    146  1.1  haya     if (NULL != (csc = (void *)config_found(self, cba, cardslot_cb_print))) {
    147  1.1  haya       /* cardbus found */
    148  1.1  haya       DPRINTF(("cardslotattach: found cardbus on %s\n", sc->sc_dev.dv_xname));
    149  1.1  haya       sc->sc_cb_softc = csc;
    150  1.1  haya     }
    151  1.1  haya   }
    152  1.1  haya 
    153  1.1  haya   if (pa != NULL) {
    154  1.1  haya     if (NULL != (psc = (void *)config_found_sm(self, pa, cardslot_16_print,
    155  1.1  haya 				       cardslot_16_submatch))) {
    156  1.1  haya       /* pcmcia 16-bit bus found */
    157  1.1  haya       DPRINTF(("cardslotattach: found 16-bit pcmcia bus\n"));
    158  1.1  haya       sc->sc_16_softc = psc;
    159  1.1  haya       /* XXX: dirty.  This code should be removed to achieve MI */
    160  1.1  haya       caa->caa_ph->pcmcia = (struct device *)psc;
    161  1.1  haya     }
    162  1.1  haya   }
    163  1.1  haya 
    164  1.1  haya   if (csc != NULL || psc != NULL) {
    165  1.1  haya #if __NetBSD_Version__ > 104060000
    166  1.1  haya     kthread_create(create_slot_manager, (void *)sc);
    167  1.1  haya #else
    168  1.1  haya     kthread_create_deferred(create_slot_manager, (void *)sc);
    169  1.1  haya #endif
    170  1.1  haya   }
    171  1.1  haya 
    172  1.1  haya   card_attach_now = sc->sc_dev.dv_cfdata->cf_flags & 0x01;
    173  1.1  haya 
    174  1.1  haya   if (csc && (csc->sc_cf->cardbus_ctrl)(csc->sc_cc, CARDBUS_CD)) {
    175  1.1  haya     DPRINTF(("cardslotattach: CardBus card found\n"));
    176  1.1  haya     if (card_attach_now) {
    177  1.1  haya       /* attach now */
    178  1.1  haya       cardbus_attach_card(sc->sc_cb_softc);
    179  1.1  haya       CARDSLOT_SET_CARDTYPE(sc->sc_status, CARDSLOT_STATUS_CARD_CB);
    180  1.1  haya     } else {
    181  1.1  haya       /* attach deffered */
    182  1.1  haya       cardslot_event_throw(sc, CARDSLOT_EVENT_INSERTION_CB);
    183  1.1  haya     }
    184  1.1  haya   }
    185  1.1  haya 
    186  1.1  haya   if (psc && (psc->pct->card_detect)(psc->pch)) {
    187  1.1  haya     DPRINTF(("cardbusattach: 16-bit card found\n"));
    188  1.1  haya     if (card_attach_now) {
    189  1.1  haya       /* attach now */
    190  1.1  haya       pcmcia_card_attach((struct device *)sc->sc_16_softc);
    191  1.1  haya       CARDSLOT_SET_CARDTYPE(sc->sc_status, CARDSLOT_STATUS_CARD_16);
    192  1.1  haya     } else {
    193  1.1  haya       /* attach deffered */
    194  1.1  haya       cardslot_event_throw(sc, CARDSLOT_EVENT_INSERTION_16);
    195  1.1  haya     }
    196  1.1  haya   }
    197  1.1  haya }
    198  1.1  haya 
    199  1.1  haya 
    200  1.1  haya 
    201  1.1  haya STATIC int
    202  1.1  haya cardslot_cb_print(aux, pcic)
    203  1.1  haya      void *aux;
    204  1.1  haya      const char *pcic;
    205  1.1  haya {
    206  1.1  haya   return UNCONF;
    207  1.1  haya }
    208  1.1  haya 
    209  1.1  haya 
    210  1.1  haya static int
    211  1.1  haya cardslot_16_submatch(parent, cf, aux)
    212  1.1  haya      struct device *parent;
    213  1.1  haya      struct cfdata *cf;
    214  1.1  haya      void *aux;
    215  1.1  haya {
    216  1.1  haya   if (cf->cf_loc[PCMCIABUSCF_CONTROLLER] != PCMCIABUSCF_CONTROLLER_DEFAULT
    217  1.1  haya       && cf->cf_loc[PCMCIABUSCF_CONTROLLER] != 0) {
    218  1.1  haya     return 0;
    219  1.1  haya   }
    220  1.1  haya 
    221  1.1  haya   if ((cf->cf_loc[PCMCIABUSCF_CONTROLLER] == PCMCIABUSCF_CONTROLLER_DEFAULT)) {
    222  1.1  haya     return ((*cf->cf_attach->ca_match)(parent, cf, aux));
    223  1.1  haya   }
    224  1.1  haya 
    225  1.1  haya   return 0;
    226  1.1  haya }
    227  1.1  haya 
    228  1.1  haya 
    229  1.1  haya 
    230  1.1  haya static int
    231  1.1  haya cardslot_16_print(arg, pnp)
    232  1.1  haya      void *arg;
    233  1.1  haya      const char *pnp;
    234  1.1  haya {
    235  1.1  haya   if (pnp) {
    236  1.1  haya     printf("pcmcia at %s", pnp);
    237  1.1  haya   }
    238  1.1  haya 
    239  1.1  haya   return UNCONF;
    240  1.1  haya }
    241  1.1  haya 
    242  1.1  haya 
    243  1.1  haya 
    244  1.1  haya 
    245  1.1  haya static void
    246  1.1  haya create_slot_manager(arg)
    247  1.1  haya      void *arg;
    248  1.1  haya {
    249  1.1  haya   struct cardslot_softc *sc = (struct cardslot_softc *)arg;
    250  1.1  haya 
    251  1.1  haya   sc->sc_th_enable = 1;
    252  1.1  haya 
    253  1.1  haya #if __NetBSD_Version__ > 104060000
    254  1.1  haya  if (kthread_create1(cardslot_event_thread, sc, &sc->sc_event_thread, "%s",
    255  1.1  haya 		     sc->sc_dev.dv_xname)) {
    256  1.1  haya #else
    257  1.1  haya  if (kthread_create(cardslot_event_thread, sc, &sc->sc_event_thread, "%s",
    258  1.1  haya 		     sc->sc_dev.dv_xname)) {
    259  1.1  haya #endif
    260  1.1  haya     printf("%s: unable to create event thread for slot %d\n",
    261  1.1  haya 	   sc->sc_dev.dv_xname, sc->sc_slot);
    262  1.1  haya     panic("create_slot_manager");
    263  1.1  haya   }
    264  1.1  haya }
    265  1.1  haya 
    266  1.1  haya 
    267  1.1  haya 
    268  1.1  haya 
    269  1.1  haya /*
    270  1.1  haya  * void cardslot_event_throw(struct cardslot_softc *sc, int ev)
    271  1.1  haya  *
    272  1.1  haya  *   This function throws an event to the event handler.  If the state
    273  1.1  haya  *   of a slot is changed, it should be noticed using this function.
    274  1.1  haya  */
    275  1.1  haya void
    276  1.1  haya cardslot_event_throw(sc, ev)
    277  1.1  haya      struct cardslot_softc *sc;
    278  1.1  haya      int ev;
    279  1.1  haya {
    280  1.1  haya   struct cardslot_event *ce;
    281  1.1  haya 
    282  1.1  haya   DPRINTF(("cardslot_event_throw: an event %s comes\n",
    283  1.1  haya 	   ev == CARDSLOT_EVENT_INSERTION_CB ? "CardBus Card inserted" :
    284  1.1  haya 	   ev == CARDSLOT_EVENT_INSERTION_16 ? "16-bit Card inserted" :
    285  1.1  haya 	   ev == CARDSLOT_EVENT_REMOVAL_CB ? "CardBus Card removed" :
    286  1.1  haya 	   ev == CARDSLOT_EVENT_REMOVAL_16 ? "16-bit Card removed" : "???"));
    287  1.1  haya 
    288  1.1  haya   if (NULL == (ce = (struct cardslot_event *)malloc(sizeof (struct cardslot_event), M_TEMP, M_NOWAIT))) {
    289  1.1  haya     panic("cardslot_enevt");
    290  1.1  haya   }
    291  1.1  haya 
    292  1.1  haya   ce->ce_type = ev;
    293  1.1  haya 
    294  1.1  haya   {
    295  1.1  haya     int s = spltty();
    296  1.1  haya     SIMPLEQ_INSERT_TAIL(&sc->sc_events, ce, ce_q);
    297  1.1  haya     splx(s);
    298  1.1  haya   }
    299  1.1  haya 
    300  1.1  haya   wakeup(&sc->sc_events);
    301  1.1  haya 
    302  1.1  haya   return;
    303  1.1  haya }
    304  1.1  haya 
    305  1.1  haya 
    306  1.1  haya /*
    307  1.1  haya  * static void cardslot_event_thread(void *arg)
    308  1.1  haya  *
    309  1.1  haya  *   This function is the main routine handing cardslot events such as
    310  1.1  haya  *   insertions and removals.
    311  1.1  haya  *
    312  1.1  haya  */
    313  1.1  haya static void
    314  1.1  haya cardslot_event_thread(arg)
    315  1.1  haya      void *arg;
    316  1.1  haya {
    317  1.1  haya   struct cardslot_softc *sc = arg;
    318  1.1  haya   struct cardslot_event *ce;
    319  1.1  haya   int s;
    320  1.1  haya   static int antonym_ev[4] = {
    321  1.1  haya     CARDSLOT_EVENT_REMOVAL_16, CARDSLOT_EVENT_INSERTION_16,
    322  1.1  haya     CARDSLOT_EVENT_REMOVAL_CB, CARDSLOT_EVENT_INSERTION_CB
    323  1.1  haya   };
    324  1.1  haya 
    325  1.1  haya   while (sc->sc_th_enable) {
    326  1.1  haya     s = spltty();
    327  1.1  haya     if ((ce = SIMPLEQ_FIRST(&sc->sc_events)) == NULL) {
    328  1.1  haya       splx(s);
    329  1.1  haya       (void) tsleep(&sc->sc_events, PWAIT, "cardslotev", 0);
    330  1.1  haya       continue;
    331  1.1  haya     }
    332  1.1  haya     SIMPLEQ_REMOVE_HEAD(&sc->sc_events, ce, ce_q);
    333  1.1  haya     splx(s);
    334  1.1  haya 
    335  1.1  haya     if (IS_CARDSLOT_INSERT_REMOVE_EV(ce->ce_type)) {
    336  1.1  haya       /* Chattering supression */
    337  1.1  haya       s = spltty();
    338  1.1  haya       while (1) {
    339  1.1  haya 	struct cardslot_event *ce1, *ce2;
    340  1.1  haya 
    341  1.1  haya 	if ((ce1 = SIMPLEQ_FIRST(&sc->sc_events)) == NULL) {
    342  1.1  haya 	  break;
    343  1.1  haya 	}
    344  1.1  haya 	if (ce1->ce_type != antonym_ev[ce->ce_type]) {
    345  1.1  haya 	  break;
    346  1.1  haya 	}
    347  1.1  haya 	if ((ce2 = SIMPLEQ_NEXT(ce1, ce_q)) == NULL) {
    348  1.1  haya 	  break;
    349  1.1  haya 	}
    350  1.1  haya 	if (ce2->ce_type == ce->ce_type) {
    351  1.1  haya 	  SIMPLEQ_REMOVE_HEAD(&sc->sc_events, ce1, ce_q);
    352  1.1  haya 	  free(ce1, M_TEMP);
    353  1.1  haya 	  SIMPLEQ_REMOVE_HEAD(&sc->sc_events, ce2, ce_q);
    354  1.1  haya 	  free(ce2, M_TEMP);
    355  1.1  haya 	}
    356  1.1  haya       }
    357  1.1  haya       splx(s);
    358  1.1  haya     }
    359  1.1  haya 
    360  1.1  haya     switch (ce->ce_type) {
    361  1.1  haya     case CARDSLOT_EVENT_INSERTION_CB:
    362  1.1  haya       if (CARDSLOT_CARDTYPE(sc->sc_status) != CARDSLOT_STATUS_CARD_NONE) {
    363  1.1  haya 	/* A card has already been inserted. */
    364  1.1  haya 	break;
    365  1.1  haya       }
    366  1.1  haya       if (sc->sc_cb_softc) {
    367  1.1  haya 	cardbus_attach_card(sc->sc_cb_softc);
    368  1.1  haya 	CARDSLOT_SET_CARDTYPE(sc->sc_status, CARDSLOT_STATUS_CARD_CB);
    369  1.1  haya       } else {
    370  1.1  haya 	panic("no cardbus on %s", sc->sc_dev.dv_xname);
    371  1.1  haya       }
    372  1.1  haya 
    373  1.1  haya       break;
    374  1.1  haya 
    375  1.1  haya     case CARDSLOT_EVENT_INSERTION_16:
    376  1.1  haya       if (CARDSLOT_CARDTYPE(sc->sc_status) != CARDSLOT_STATUS_CARD_NONE) {
    377  1.1  haya 	/* A card has already been inserted. */
    378  1.1  haya 	break;
    379  1.1  haya       }
    380  1.1  haya       if (sc->sc_16_softc) {
    381  1.1  haya 	pcmcia_card_attach((struct device *)sc->sc_16_softc);
    382  1.1  haya 	CARDSLOT_SET_CARDTYPE(sc->sc_status, CARDSLOT_STATUS_CARD_16);
    383  1.1  haya       } else {
    384  1.1  haya 	panic("no 16-bit pcmcia on %s", sc->sc_dev.dv_xname);
    385  1.1  haya       }
    386  1.1  haya 
    387  1.1  haya       break;
    388  1.1  haya 
    389  1.1  haya     case CARDSLOT_EVENT_REMOVAL_CB:
    390  1.1  haya       if (CARDSLOT_CARDTYPE(sc->sc_status) != CARDSLOT_STATUS_CARD_CB) {
    391  1.1  haya 	/* CardBus card has not been inserted. */
    392  1.1  haya 	break;
    393  1.1  haya       }
    394  1.1  haya 				/* not yet */
    395  1.1  haya       CARDSLOT_SET_CARDTYPE(sc->sc_status, CARDSLOT_STATUS_CARD_NONE);
    396  1.1  haya       break;
    397  1.1  haya 
    398  1.1  haya     case CARDSLOT_EVENT_REMOVAL_16:
    399  1.1  haya       DPRINTF(("%s: removal event\n", sc->sc_dev.dv_xname));
    400  1.1  haya       if (CARDSLOT_CARDTYPE(sc->sc_status) != CARDSLOT_STATUS_CARD_16) {
    401  1.1  haya 	/* 16-bit card has not been inserted. */
    402  1.1  haya 	break;
    403  1.1  haya       }
    404  1.1  haya       if (sc->sc_16_softc) {
    405  1.1  haya 	struct pcmcia_softc *psc = sc->sc_16_softc;
    406  1.1  haya 
    407  1.1  haya 	pcmcia_card_deactivate((struct device *)psc);
    408  1.1  haya 	pcmcia_chip_socket_disable(psc->pct, psc->pch);
    409  1.1  haya 	pcmcia_card_detach((struct device *)psc, DETACH_FORCE);
    410  1.1  haya 	CARDSLOT_SET_CARDTYPE(sc->sc_status, CARDSLOT_STATUS_CARD_NONE);
    411  1.1  haya       }
    412  1.1  haya       break;
    413  1.1  haya 
    414  1.1  haya     default:
    415  1.1  haya       panic("cardslot_event_thread: unknown event %d", ce->ce_type);
    416  1.1  haya     }
    417  1.1  haya     free(ce, M_TEMP);
    418  1.1  haya   }
    419  1.1  haya 
    420  1.1  haya   sc->sc_event_thread = NULL;
    421  1.1  haya 
    422  1.1  haya   /* In case parent is waiting for us to exit. */
    423  1.1  haya   wakeup(sc);
    424  1.1  haya 
    425  1.1  haya   kthread_exit(0);
    426  1.1  haya }
    427