root/sys/dev/cardbus/cardslot.c
/*      $NetBSD: cardslot.c,v 1.60 2021/08/07 16:19:10 thorpej Exp $    */

/*
 * Copyright (c) 1999 and 2000
 *       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.
 *
 * 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.
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: cardslot.c,v 1.60 2021/08/07 16:19:10 thorpej Exp $");

#include "opt_cardslot.h"

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/malloc.h>
#include <sys/kernel.h>
#include <sys/syslog.h>
#include <sys/kthread.h>

#include <sys/bus.h>

#include <dev/cardbus/cardslotvar.h>
#include <dev/cardbus/cardbusvar.h>
#include <dev/pcmcia/pcmciavar.h>
#include <dev/pcmcia/pcmciachip.h>

#include "locators.h"

#if defined CARDSLOT_DEBUG
#define STATIC
#define DPRINTF(a) printf a
#else
#define STATIC static
#define DPRINTF(a)
#endif

int pcmcia_error(device_t);
int
pcmcia_error(device_t dev)
{

        return 1;
}
__weak_alias(pcmcia_card_attach, pcmcia_error);
__weak_alias(pcmcia_card_deactivate, pcmcia_error);
__weak_alias(pcmcia_card_detach, pcmcia_error);


STATIC void cardslotchilddet(device_t, device_t);
STATIC void cardslotattach(device_t, device_t, void *);
STATIC int cardslotdetach(device_t, int);

STATIC int cardslotmatch(device_t, cfdata_t, void *);
static void cardslot_event_thread(void *arg);

STATIC int cardslot_cb_print(void *aux, const char *pcic);
static int cardslot_16_print(void *, const char *);
static int cardslot_16_submatch(device_t, cfdata_t, const int *, void *);

CFATTACH_DECL3_NEW(cardslot, sizeof(struct cardslot_softc),
    cardslotmatch, cardslotattach, cardslotdetach, NULL, NULL, cardslotchilddet,
    DVF_DETACH_SHUTDOWN);

STATIC int
cardslotmatch(device_t parent, cfdata_t cf,
    void *aux)
{
        struct cardslot_attach_args *caa = aux;

        if (caa->caa_cb_attach == NULL && caa->caa_16_attach == NULL) {
                /* Neither CardBus nor 16-bit PCMCIA are defined. */
                return 0;
        }

        return 1;
}

STATIC void
cardslotchilddet(device_t self, device_t child)
{
        struct cardslot_softc *sc = device_private(self);

        KASSERT(sc->sc_cb_softc == device_private(child) ||
            sc->sc_16_softc == child);

        if (sc->sc_cb_softc == device_private(child))
                sc->sc_cb_softc = NULL;
        else if (sc->sc_16_softc == child)
                sc->sc_16_softc = NULL;
}

STATIC void
cardslotattach(device_t parent, device_t self, void *aux)
{
        struct cardslot_softc *sc = device_private(self);
        struct cardslot_attach_args *caa = aux;

        struct cbslot_attach_args *cba = caa->caa_cb_attach;
        struct pcmciabus_attach_args *pa = caa->caa_16_attach;

        struct cardbus_softc *csc = NULL;
        struct pcmcia_softc *psc = NULL;

        sc->sc_dev = self;

        sc->sc_cb_softc = NULL;
        sc->sc_16_softc = NULL;
        SIMPLEQ_INIT(&sc->sc_events);
        sc->sc_th_enable = 0;
        mutex_init(&sc->sc_event_lock, MUTEX_DEFAULT, IPL_TTY);
        cv_init(&sc->sc_event_cv, "evexit");

        aprint_naive("\n");
        aprint_normal("\n");

        DPRINTF(("%s attaching CardBus bus...\n", device_xname(self)));
        if (cba != NULL) {
                csc = device_private(config_found(self, cba, cardslot_cb_print,
                    CFARGS(.iattr = "cbbus")));
                if (csc) {
                        /* cardbus found */
                        DPRINTF(("%s: found cardbus on %s\n", __func__,
                                 device_xname(self)));
                        sc->sc_cb_softc = csc;
                }
        }

        if (pa != NULL) {
                sc->sc_16_softc = config_found(self, pa, cardslot_16_print,
                    CFARGS(.submatch = cardslot_16_submatch,
                           .iattr = "pcmciabus"));
                if (sc->sc_16_softc) {
                        /* pcmcia 16-bit bus found */
                        DPRINTF(("%s: found 16-bit pcmcia bus\n", __func__));
                        psc = device_private(sc->sc_16_softc);
                }
        }

        if (csc != NULL || psc != NULL) {
                sc->sc_th_enable = 1;
                config_pending_incr(self);
                if (kthread_create(PRI_NONE, 0, NULL, cardslot_event_thread,
                    sc, &sc->sc_event_thread, "%s", device_xname(self))) {
                        aprint_error_dev(sc->sc_dev,
                                         "unable to create thread\n");
                        panic("cardslotattach");
                }
        }

        if (csc && (csc->sc_cf->cardbus_ctrl)(csc->sc_cc, CARDBUS_CD)) {
                DPRINTF(("%s: CardBus card found\n", __func__));
                /* attach deferred */
                cardslot_event_throw(sc, CARDSLOT_EVENT_INSERTION_CB);
        }

        if (psc && (psc->pct->card_detect)(psc->pch)) {
                DPRINTF(("%s: 16-bit card found\n", __func__));
                /* attach deferred */
                cardslot_event_throw(sc, CARDSLOT_EVENT_INSERTION_16);
        }

        if (!pmf_device_register(self, NULL, NULL))
                aprint_error_dev(self, "couldn't establish power handler\n");
}

STATIC int
cardslotdetach(device_t self, int flags)
{
        int rc;
        struct cardslot_softc *sc = device_private(self);

        if ((rc = config_detach_children(self, flags)) != 0)
                return rc;

        mutex_enter(&sc->sc_event_lock);

        if (sc->sc_event_thread != NULL) {
                sc->sc_th_enable = 0;
                cv_signal(&sc->sc_event_cv);
                while (sc->sc_event_thread != NULL) {
                        cv_wait(&sc->sc_event_cv, &sc->sc_event_lock);
                }
        }

        if (!SIMPLEQ_EMPTY(&sc->sc_events))
                aprint_error_dev(self, "events outstanding");

        mutex_exit(&sc->sc_event_lock);

        mutex_destroy(&sc->sc_event_lock);
        cv_destroy(&sc->sc_event_cv);

        pmf_device_deregister(self);
        return 0;
}

STATIC int
cardslot_cb_print(void *aux, const char *pnp)
{
        struct cbslot_attach_args *cba = aux;

        if (pnp != NULL) {
                aprint_normal("cardbus at %s subordinate bus %d",
                    pnp, cba->cba_bus);
        }

        return UNCONF;
}


static int
cardslot_16_submatch(device_t parent, cfdata_t cf,
    const int *ldesc, void *aux)
{

        if (cf->cf_loc[PCMCIABUSCF_CONTROLLER] != PCMCIABUSCF_CONTROLLER_DEFAULT
            && cf->cf_loc[PCMCIABUSCF_CONTROLLER] != 0) {
                return 0;
        }

        if (cf->cf_loc[PCMCIABUSCF_CONTROLLER] == PCMCIABUSCF_CONTROLLER_DEFAULT) {
                return (config_match(parent, cf, aux));
        }

        return 0;
}



static int
cardslot_16_print(void *arg, const char *pnp)
{

        if (pnp != NULL) {
                aprint_normal("pcmciabus at %s", pnp);
        }

        return UNCONF;
}


/*
 * void cardslot_event_throw(struct cardslot_softc *sc, int ev)
 *
 *   This function throws an event to the event handler.  If the state
 *   of a slot is changed, it should be noticed using this function.
 */
void
cardslot_event_throw(struct cardslot_softc *sc, int ev)
{
        struct cardslot_event *ce;

        DPRINTF(("cardslot_event_throw: an event %s comes\n",
            ev == CARDSLOT_EVENT_INSERTION_CB ? "CardBus Card inserted" :
            ev == CARDSLOT_EVENT_INSERTION_16 ? "16-bit Card inserted" :
            ev == CARDSLOT_EVENT_REMOVAL_CB ? "CardBus Card removed" :
            ev == CARDSLOT_EVENT_REMOVAL_16 ? "16-bit Card removed" : "???"));

        if (NULL == (ce = (struct cardslot_event *)malloc(sizeof (struct cardslot_event), M_TEMP, M_NOWAIT))) {
                panic("cardslot_enevt");
        }

        ce->ce_type = ev;

        mutex_enter(&sc->sc_event_lock);
        SIMPLEQ_INSERT_TAIL(&sc->sc_events, ce, ce_q);
        mutex_exit(&sc->sc_event_lock);

        cv_signal(&sc->sc_event_cv);

        return;
}


/*
 * static void cardslot_event_thread(void *arg)
 *
 *   This function is the main routine handing cardslot events such as
 *   insertions and removals.
 *
 */
static void
cardslot_event_thread(void *arg)
{
        struct cardslot_softc *sc = arg;
        struct cardslot_event *ce;
        int first = 1;
        static int antonym_ev[4] = {
                CARDSLOT_EVENT_REMOVAL_16, CARDSLOT_EVENT_INSERTION_16,
                CARDSLOT_EVENT_REMOVAL_CB, CARDSLOT_EVENT_INSERTION_CB
        };

        mutex_enter(&sc->sc_event_lock);
        while (sc->sc_th_enable) {
                if ((ce = SIMPLEQ_FIRST(&sc->sc_events)) == NULL) {
                        if (first) {
                                first = 0;
                                mutex_exit(&sc->sc_event_lock);
                                config_pending_decr(sc->sc_dev);
                                mutex_enter(&sc->sc_event_lock);
                        }
                        cv_wait(&sc->sc_event_cv, &sc->sc_event_lock);
                        continue;
                }
                SIMPLEQ_REMOVE_HEAD(&sc->sc_events, ce_q);

                if (IS_CARDSLOT_INSERT_REMOVE_EV(ce->ce_type)) {
                        /* Chattering suppression */
                        while (1) {
                                struct cardslot_event *ce1, *ce2;

                                if ((ce1 = SIMPLEQ_FIRST(&sc->sc_events)) == NULL) {
                                        break;
                                }
                                if (ce1->ce_type != antonym_ev[ce->ce_type]) {
                                        break;
                                }
                                if ((ce2 = SIMPLEQ_NEXT(ce1, ce_q)) == NULL) {
                                        break;
                                }
                                if (ce2->ce_type == ce->ce_type) {
                                        SIMPLEQ_REMOVE_HEAD(&sc->sc_events,
                                            ce_q);
                                        free(ce1, M_TEMP);
                                        SIMPLEQ_REMOVE_HEAD(&sc->sc_events,
                                            ce_q);
                                        free(ce2, M_TEMP);
                                }
                        }
                }
                mutex_exit(&sc->sc_event_lock);

                switch (ce->ce_type) {
                case CARDSLOT_EVENT_INSERTION_CB:
                        if ((CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_CB)
                            || (CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_16)) {
                                if (CARDSLOT_WORK(sc->sc_status) == CARDSLOT_STATUS_WORKING) {
                                        /*
                                         * A card has already been
                                         * inserted and works.
                                         */
                                        break;
                                }
                        }

                        if (sc->sc_cb_softc) {
                                CARDSLOT_SET_CARDTYPE(sc->sc_status,
                                    CARDSLOT_STATUS_CARD_CB);
                                if (cardbus_attach_card(sc->sc_cb_softc) > 0) {
                                        /* at least one function works */
                                        CARDSLOT_SET_WORK(sc->sc_status, CARDSLOT_STATUS_WORKING);
                                } else {
                                        /*
                                         * no functions work or this
                                         * card is not known
                                         */
                                        CARDSLOT_SET_WORK(sc->sc_status,
                                            CARDSLOT_STATUS_NOTWORK);
                                }
                        } else {
                                printf("%s: no cardbus on %s\n", __func__,
                                      device_xname(sc->sc_dev));
                                CARDSLOT_SET_WORK(sc->sc_status,
                                    CARDSLOT_STATUS_NOTWORK);
                        }

                        break;

                case CARDSLOT_EVENT_INSERTION_16:
                        if ((CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_CB)
                            || (CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_16)) {
                                if (CARDSLOT_WORK(sc->sc_status) == CARDSLOT_STATUS_WORKING) {
                                        /*
                                         * A card has already been
                                         * inserted and work.
                                         */
                                        break;
                                }
                        }
                        if (sc->sc_16_softc) {
                                CARDSLOT_SET_CARDTYPE(sc->sc_status, CARDSLOT_STATUS_CARD_16);
                                if (pcmcia_card_attach(sc->sc_16_softc)) {
                                        /* Do not attach */
                                        CARDSLOT_SET_WORK(sc->sc_status,
                                            CARDSLOT_STATUS_NOTWORK);
                                } else {
                                        /* working */
                                        CARDSLOT_SET_WORK(sc->sc_status,
                                            CARDSLOT_STATUS_WORKING);
                                }
                        } else {
                                printf("%s: no 16-bit pcmcia on %s\n", __func__,
                                      device_xname(sc->sc_dev));
                                CARDSLOT_SET_WORK(sc->sc_status,
                                    CARDSLOT_STATUS_NOTWORK);
                        }

                        break;

                case CARDSLOT_EVENT_REMOVAL_CB:
                        if (CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_CB) {
                                /* CardBus card has not been inserted. */
                                if (CARDSLOT_WORK(sc->sc_status) == CARDSLOT_STATUS_WORKING) {
                                        cardbus_detach_card(sc->sc_cb_softc);
                                        CARDSLOT_SET_WORK(sc->sc_status,
                                            CARDSLOT_STATUS_NOTWORK);
                                        CARDSLOT_SET_WORK(sc->sc_status,
                                            CARDSLOT_STATUS_CARD_NONE);
                                }
                                CARDSLOT_SET_CARDTYPE(sc->sc_status,
                                    CARDSLOT_STATUS_CARD_NONE);
                        } else if (CARDSLOT_CARDTYPE(sc->sc_status) != CARDSLOT_STATUS_CARD_16) {
                                /* Unknown card... */
                                CARDSLOT_SET_CARDTYPE(sc->sc_status,
                                    CARDSLOT_STATUS_CARD_NONE);
                        }
                        CARDSLOT_SET_WORK(sc->sc_status,
                            CARDSLOT_STATUS_NOTWORK);
                        break;

                case CARDSLOT_EVENT_REMOVAL_16:
                        DPRINTF(("%s: removal event\n", device_xname(sc->sc_dev)));
                        if (CARDSLOT_CARDTYPE(sc->sc_status) != CARDSLOT_STATUS_CARD_16) {
                                /* 16-bit card has not been inserted. */
                                break;
                        }
                        if ((sc->sc_16_softc != NULL)
                            && (CARDSLOT_WORK(sc->sc_status) == CARDSLOT_STATUS_WORKING)) {
                                struct pcmcia_softc *psc =
                                        device_private(sc->sc_16_softc);

                                pcmcia_card_deactivate(sc->sc_16_softc);
                                pcmcia_chip_socket_disable(psc->pct, psc->pch);
                                pcmcia_card_detach(sc->sc_16_softc,
                                                   DETACH_FORCE);
                        }
                        CARDSLOT_SET_CARDTYPE(sc->sc_status, CARDSLOT_STATUS_CARD_NONE);
                        CARDSLOT_SET_WORK(sc->sc_status, CARDSLOT_STATUS_NOTWORK);
                        break;

                default:
                        panic("cardslot_event_thread: unknown event %d", ce->ce_type);
                }
                free(ce, M_TEMP);
                mutex_enter(&sc->sc_event_lock);
        }

        /* The parent device is waiting for us to exit. */
        sc->sc_event_thread = NULL;

        cv_signal(&sc->sc_event_cv);
        mutex_exit(&sc->sc_event_lock);

        kthread_exit(0);
}