root/sys/arch/evbarm/g42xxeb/gb225_pcic.c
/*
 * Copyright (c) 2002, 2003, 2005  Genetec corp.  All rights reserved.
 *
 * PCMCIA/CF support for TWINTAIL (G4255EB)
 * Written by Hiroyuki Bessho for Genetec corp.
 *
 * 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. The name of Genetec corp. may not be used to endorse
 *    or promote products derived from this software without specific prior
 *    written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY GENETEC CORP. ``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 GENETEC CORP.
 * 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/types.h>
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/callout.h>
#include <sys/kernel.h>
#include <sys/kthread.h>
#include <uvm/uvm.h>

#include <sys/bus.h>
#include <machine/intr.h>

#include <dev/pcmcia/pcmciareg.h>
#include <dev/pcmcia/pcmciavar.h>
#include <dev/pcmcia/pcmciachip.h>

#include <arch/arm/xscale/pxa2x0var.h>
#include <arch/arm/xscale/pxa2x0reg.h>
#include <arch/arm/sa11x0/sa11xx_pcicvar.h>
#include <arch/evbarm/g42xxeb/g42xxeb_reg.h>
#include <arch/evbarm/g42xxeb/g42xxeb_var.h>
#include <arch/evbarm/g42xxeb/gb225reg.h>
#include <arch/evbarm/g42xxeb/gb225var.h>


//#define DONT_USE_CARD_DETECT_INTR

#define PCMCIA_INT      G42XXEB_INT_EXT1
#define CF_INT          G42XXEB_INT_EXT0

#ifdef DEBUG
#define DPRINTF(arg)    printf arg
#else
#define DPRINTF(arg)
#endif

struct opcic_softc;

struct opcic_socket {
        struct sapcic_socket ss;        /* inherit socket for sa11x0 pcic */

#if 0
        int voltage;                    /* card power voltage selected by
                                           upper layer */
#endif
};

struct opcic_softc {
        struct sapcic_softc sc_pc;      /* inherit SA11xx pcic */

        struct opcic_socket sc_socket[2];
        int sc_cards;
        bus_space_handle_t sc_memctl_ioh;
};

static int      opcic_match(device_t, cfdata_t, void *);
static void     opcic_attach(device_t, device_t, void *);
static int      opcic_print(void *, const char *);

static  int     opcic_read(struct sapcic_socket *, int);
static  void    opcic_write(struct sapcic_socket *, int, int);
static  void    opcic_set_power(struct sapcic_socket *, int);
static  void    opcic_clear_intr(int);
static  void    *opcic_intr_establish(struct sapcic_socket *, int,
                                       int (*)(void *), void *);
static  void    opcic_intr_disestablish(struct sapcic_socket *, void *);
#ifndef DONT_USE_CARD_DETECT_INTR
static  int     opcic_card_detect(void *, int);
#endif

CFATTACH_DECL_NEW(opcic, sizeof(struct opcic_softc),
    opcic_match, opcic_attach, NULL, NULL);

static struct sapcic_tag opcic_tag = {
        opcic_read,
        opcic_write,
        opcic_set_power,
        opcic_clear_intr,
        opcic_intr_establish,
        opcic_intr_disestablish,
};


#define HAVE_CARD(r)    (((r)&CARDDET_DET)==0)

static inline uint8_t
opcic_read_card_status(struct opcic_socket *so)
{
        struct opcic_softc *sc = (struct opcic_softc *)(so->ss.sc);
        struct opio_softc *osc = 
            device_private(device_parent(sc->sc_pc.sc_dev));

        return bus_space_read_1(osc->sc_iot, osc->sc_ioh,
            GB225_CFDET + 2 * so->ss.socket);

}

static int
opcic_match(device_t parent, cfdata_t cf, void *aux)
{
        return  1;
}

static void
opcic_attach(device_t parent, device_t self, void *aux)
{
        int i;
        struct pcmciabus_attach_args paa;
        struct opcic_softc *sc = device_private(self);
        struct opio_softc *psc = device_private(parent);
        struct obio_softc *bsd = device_private(device_parent(parent));
        bus_space_handle_t memctl_ioh = bsd->sc_memctl_ioh;
        bus_space_tag_t iot =  psc->sc_iot;

        printf("\n");

        /* tell PXA2X0 that we have two sockets */
#if 0
        bus_space_write_4(iot, memctl_ioh, MEMCTL_MECR, MECR_NOS);
#else
        bus_space_write_4(iot, memctl_ioh, MEMCTL_MECR, MECR_CIT|MECR_NOS);
#endif
        sc->sc_pc.sc_iot = psc->sc_iot;
        sc->sc_memctl_ioh = memctl_ioh;

        sc->sc_cards = 0;

        for(i = 0; i < 2; i++) {
                sc->sc_socket[i].ss.sc = &sc->sc_pc;
                sc->sc_socket[i].ss.socket = i;
                sc->sc_socket[i].ss.pcictag_cookie = NULL;
                sc->sc_socket[i].ss.pcictag = &opcic_tag;
                sc->sc_socket[i].ss.event_thread = NULL;
                sc->sc_socket[i].ss.event = 0;
                sc->sc_socket[i].ss.laststatus = CARDDET_NOCARD;
                sc->sc_socket[i].ss.shutdown = 0;

                sc->sc_socket[i].ss.power_capability = 
                    (SAPCIC_POWER_5V|SAPCIC_POWER_3V);

                bus_space_write_4(iot, memctl_ioh, MEMCTL_MCIO(i), 
                    MC_TIMING_VAL(1,1,1));
#if 0
                bus_space_write_4(iot, memctl_ioh, MEMCTL_MCATT(i), 
                    MC_TIMING_VAL(31,31,31));
#endif

                paa.paa_busname = "pcmcia";
                paa.pct = (pcmcia_chipset_tag_t)&sa11x0_pcmcia_functions;
                paa.pch = (pcmcia_chipset_handle_t)&sc->sc_socket[i].ss;

                sc->sc_socket[i].ss.pcmcia =
                    config_found(sc->sc_pc.sc_dev, &paa, opcic_print,
                                 CFARGS_NONE);

#ifndef DONT_USE_CARD_DETECT_INTR
                /* interrupt for card insertion/removal */
                opio_intr_establish(psc,
                    i==0 ? OPIO_INTR_CF_INSERT : OPIO_INTR_PCMCIA_INSERT,
                    IPL_BIO, opcic_card_detect, &sc->sc_socket[i]);
#else
                bus_space_write_4(iot, ioh, MEMCTL_MECR, MECR_NOS | MECR_CIT);

#endif

                /* schedule kthread creation */
                sapcic_kthread_create(&sc->sc_socket[i].ss);
        }

}

static int
opcic_print(void *aux, const char *name)
{
        return (UNCONF);
}

#ifndef DONT_USE_CARD_DETECT_INTR
static int
opcic_card_detect(void *arg, int val)
{
        struct opcic_socket *socket = arg;
        struct opcic_softc *sc = (struct opcic_softc *)socket->ss.sc;
        bus_space_tag_t iot = sc->sc_pc.sc_iot;
        bus_space_handle_t memctl_ioh = sc->sc_memctl_ioh;
        int sock_no = socket->ss.socket;
        int last, s;

        s = splbio();
        last = sc->sc_cards;
        if (HAVE_CARD(val)) {
                sc->sc_cards |= 1<<sock_no;
                /* if it is the first card, turn on expansion memory
                 * control. */
                if (last == 0)
                        bus_space_write_4(iot, memctl_ioh, MEMCTL_MECR, 
                            MECR_NOS | MECR_CIT);
        }
        else {
                sc->sc_cards &= ~(1<<sock_no);
                /* if we loast all cards, turn off expansion memory
                 * control. */
#if 0
                if (sc->sc_cards == 0)
                        bus_space_write_4(iot, memctl_ioh, 
                            MEMCTL_MECR, MECR_NOS);
#endif
        }
        splx(s);

        DPRINTF(("%s: card %d %s\n", device_xname(sc->sc_pc.sc_dev), sock_no,
            HAVE_CARD(val) ? "inserted" : "removed"));

        sapcic_intr(arg);

        return 1;
}
#endif /* DONT_USE_CARD_DETECT_INTR */

static int
opcic_read(struct sapcic_socket *__so, int which)
{
        struct opcic_socket *so = (struct opcic_socket *)__so;
        uint8_t reg;

        reg = opcic_read_card_status(so);

        switch (which) {
        case SAPCIC_STATUS_CARD:
                return HAVE_CARD(reg) ? 
                    SAPCIC_CARD_VALID : SAPCIC_CARD_INVALID;

        case SAPCIC_STATUS_VS1:
                return (reg & CARDDET_NVS1) == 0;

        case SAPCIC_STATUS_VS2:
                return (reg & CARDDET_NVS2) == 0;

        case SAPCIC_STATUS_READY:
                return 1;

        default:
                panic("%s: bogus register", __func__);
        }
}

static void
opcic_write(struct sapcic_socket *__so, int which, int arg)
{
        struct opcic_socket *so = (struct opcic_socket *)__so;
        struct opcic_softc *sc = (struct opcic_softc *)so->ss.sc;
        struct opio_softc *psc = 
             device_private(device_parent(sc->sc_pc.sc_dev));
        struct obio_softc *bsc = 
             device_private(device_parent(psc->sc_dev));

        switch (which) {
        case SAPCIC_CONTROL_RESET:
                obio_peripheral_reset(bsc, so->ss.socket, arg);
                delay(500*1000);
                break;

        case SAPCIC_CONTROL_LINEENABLE:
                break;

        case SAPCIC_CONTROL_WAITENABLE:
                break;

        case SAPCIC_CONTROL_POWERSELECT:
#if 0
                so->voltage = arg;
#endif
                break;

        default:
                panic("%s: bogus register", __func__);
        }
}

static void
opcic_set_power(struct sapcic_socket *__so, int arg)
{
        struct opcic_socket *so = (struct opcic_socket *)__so;
        struct opcic_softc *sc = (struct opcic_softc *)so->ss.sc;
        struct opio_softc *psc = 
            device_private(device_parent(sc->sc_pc.sc_dev));
        int shift, save;
        volatile uint8_t *p;

        if( arg < 0 || SAPCIC_POWER_5V < arg )
                panic("sacpcic_set_power: bogus arg\n");
                        
        DPRINTF(("card %d: DET=%x\n",
            so->ss.socket,
            bus_space_read_1(psc->sc_iot, psc->sc_ioh,
                GB225_CFDET + 2*so->ss.socket)));

        p = (volatile uint8_t *)bus_space_vaddr(psc->sc_iot, psc->sc_ioh)
            + GB225_CARDPOW;

        shift = 4 * !so->ss.socket;

        save = disable_interrupts(I32_bit);
        *p = (*p & ~(0x0f << shift)) | ((CARDPOW_VPPVCC | (arg<<2)) << shift);
        restore_interrupts(save);

        DPRINTF(("card %d power: %x\n", so->ss.socket, *p));
}

static void
opcic_clear_intr(int arg)
{
}

static void *
opcic_intr_establish(struct sapcic_socket *so, int level, 
    int (* ih_fun)(void *), void *ih_arg)
{
        struct opcic_softc *sc = (struct opcic_softc *)so->sc;
        struct opio_softc *psc = 
            device_private(device_parent(sc->sc_pc.sc_dev));
        struct obio_softc *bsc = 
            device_private(device_parent(psc->sc_dev));
        int irq;

        DPRINTF(("opcic_intr_establish %d\n", so->socket));

        irq = so->socket ? PCMCIA_INT : CF_INT;
        return obio_intr_establish(bsc, irq, level, IST_EDGE_FALLING,
            ih_fun, ih_arg);
}

static void
opcic_intr_disestablish(struct sapcic_socket *so, void *ih)
{
        struct opcic_softc *sc = (struct opcic_softc *)so->sc;
        struct opio_softc *psc = 
            device_private(device_parent(sc->sc_pc.sc_dev));
        struct obio_softc *bsc = 
            device_private(device_parent(psc->sc_dev));
        int (* func)(void *) = ((struct obio_handler *)ih)->func;

        int irq = so->socket ? PCMCIA_INT : CF_INT;

        obio_intr_disestablish(bsc, irq, func);
}