root/sys/arch/arm/gemini/gemini_lpc.c
/*      $NetBSD: gemini_lpc.c,v 1.6 2021/08/07 16:18:44 thorpej Exp $   */

#include "opt_gemini.h"
#include "locators.h"

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: gemini_lpc.c,v 1.6 2021/08/07 16:18:44 thorpej Exp $");

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <arch/arm/gemini/gemini_lpcvar.h>
#include <arch/arm/gemini/gemini_lpchcvar.h>
#include <arch/arm/gemini/gemini_reg.h>


/* XXX these should be in lpcreg.h or it8721reg.h */
#define IT8712_CFGCTL           0x02
# define CFGCTL_WAITKEY         __BIT(1)
#define IT8712_LDN              0x07
#define IT8712_CHIPID1          0x20
#define IT8712_CHIPID2          0x21
#define IT8712_CSCV             0x22
# define CSCV_VERSION           __BITS(3,0);
#define IT8712_CLKSEL           0x23
#define IT8712_SWSUSPEND        0x24
#define IT8712_ADDR             0x2e
#define IT8712_DATA             0x2f

static int  gemini_lpc_match(device_t, cfdata_t, void *);
static void gemini_lpc_attach(device_t, device_t, void *);
static int  gemini_lpc_search(device_t, cfdata_t, const int *, void *);
static int  gemini_lpc_busprint(void *, const char *);

static uint8_t it8712_pnp_read(lpctag_t, int, uint);
static void    it8712_pnp_write(lpctag_t, int, uint, uint8_t);
static void    it8712_pnp_enter(lpctag_t);
static void    it8712_pnp_exit(lpctag_t);
static void   *it8712_intr_establish(lpctag_t, uint, int, int, int (*)(void *), void *);
static void    it8712_intr_disestablish(lpctag_t, void *);

CFATTACH_DECL_NEW(lpc, sizeof(struct gemini_lpc_softc),
    gemini_lpc_match, gemini_lpc_attach, NULL, NULL);

gemini_lpc_bus_ops_t gemini_lpc_bus_ops = {
        it8712_pnp_read,
        it8712_pnp_write,
        it8712_pnp_enter,
        it8712_pnp_exit,
        it8712_intr_establish,
        it8712_intr_disestablish,
};


static int
gemini_lpc_match(device_t parent, cfdata_t cf, void *aux)
{
        struct gemini_lpc_attach_args *lpc = aux;

        if (lpc->lpc_addr == LPCCF_ADDR_DEFAULT)
                panic("lpc must have addr specified in config.");

        return 1;
}

static void
gemini_lpc_attach(device_t parent, device_t self, void *aux)
{
        gemini_lpc_softc_t *sc = device_private(self);
        struct gemini_lpchc_attach_args *lpchc = aux;
        bus_space_tag_t iot;
        bus_space_handle_t ioh;
        uint8_t id1, id2, vers, clk, susp;

        sc->sc_addr = lpchc->lpchc_addr;
#if 0
        sc->sc_size = lpchc->lpchc_size;
#else
        /*
         * we just map the configuration registers
         * child devices can map their own I/O
         */
        sc->sc_size = 4096;
#endif

        iot = lpchc->lpchc_iot;
        if (bus_space_map(iot, sc->sc_addr, sc->sc_size, 0, &ioh))
                panic("%s: Cannot map registers", device_xname(self));
        sc->sc_iot = iot;
        sc->sc_ioh = ioh;

        it8712_pnp_enter(sc);
        id1  = it8712_pnp_read(sc, GEMINI_LPC_LDN_ALL, IT8712_CHIPID1);
        id2  = it8712_pnp_read(sc, GEMINI_LPC_LDN_ALL, IT8712_CHIPID2);
        vers = it8712_pnp_read(sc, GEMINI_LPC_LDN_ALL, IT8712_CSCV);
        vers &= CSCV_VERSION;
        clk  = it8712_pnp_read(sc, GEMINI_LPC_LDN_ALL, IT8712_CLKSEL);
        susp = it8712_pnp_read(sc, GEMINI_LPC_LDN_ALL, IT8712_SWSUSPEND);
        it8712_pnp_exit(sc);

        aprint_normal("\n%s: chip ID %x%x, version %d",
                device_xname(self), id1, id2, vers);
        aprint_normal("\n%s: clksel %#x, susp %#x ",
                device_xname(self), clk, susp);

        sc->sc_lpchctag = lpchc->lpchc_tag;
        sc->sc_bus_ops  = &gemini_lpc_bus_ops;

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

        /*
         * attach the rest of our devices
         */
        config_search(self, NULL,
            CFARGS(.search = gemini_lpc_search));
}

static int
gemini_lpc_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux)
{
        gemini_lpc_softc_t *sc = device_private(parent);
        gemini_lpc_attach_args_t lpc;

        lpc.lpc_ldn      = cf->cf_loc[LPCCF_LDN];
        lpc.lpc_addr     = cf->cf_loc[LPCCF_ADDR];
        lpc.lpc_size     = cf->cf_loc[LPCCF_SIZE];
        lpc.lpc_intr     = cf->cf_loc[LPCCF_INTR];
        lpc.lpc_iot      = sc->sc_iot;
        lpc.lpc_tag      = sc;
        lpc.lpc_base     = sc->sc_addr;

        if (config_probe(parent, cf, &lpc)) {
                config_attach(parent, cf, &lpc, gemini_lpc_busprint, CFARGS_NONE);
                return 0;                       /* love it */
        }

        return UNCONF;                          /* hate it */
}

static int
gemini_lpc_busprint(void *aux, const char *name)
{
        struct gemini_lpc_attach_args *lpc = aux;

        if (lpc->lpc_ldn != LPCCF_LDN_DEFAULT)
                aprint_normal(" ldn %d", lpc->lpc_ldn);
        if (lpc->lpc_addr != LPCCF_ADDR_DEFAULT)
                aprint_normal(" addr %#lx", lpc->lpc_addr);
        if (lpc->lpc_size != LPCCF_SIZE_DEFAULT)
                aprint_normal(" size %#lx", lpc->lpc_size);
        if (lpc->lpc_intr != LPCCF_INTR_DEFAULT)
                aprint_normal(" intr %d", lpc->lpc_intr);

        return UNCONF;
}

/*
 * LPC bus ops
 */

static uint8_t
it8712_pnp_read(lpctag_t tag, int ldn, uint index)
{
        gemini_lpc_softc_t *sc = tag;
        bus_space_tag_t iot = sc->sc_iot;
        bus_space_handle_t ioh = sc->sc_ioh;

        if (ldn != GEMINI_LPC_LDN_ALL) {
                bus_space_write_1(iot, ioh, IT8712_ADDR, IT8712_LDN);
                bus_space_write_1(iot, ioh, IT8712_DATA, ldn);
        }
        bus_space_write_1(iot, ioh, IT8712_ADDR, index);
        return bus_space_read_1(iot, ioh, IT8712_DATA);
}

static void
it8712_pnp_write(lpctag_t tag, int ldn, uint index, uint8_t val)
{
        gemini_lpc_softc_t *sc = tag;
        bus_space_tag_t iot = sc->sc_iot;
        bus_space_handle_t ioh = sc->sc_ioh;

        if (ldn != GEMINI_LPC_LDN_ALL) {
                bus_space_write_1(iot, ioh, IT8712_ADDR, IT8712_LDN);
                bus_space_write_1(iot, ioh, IT8712_DATA, ldn);
        }
        bus_space_write_1(iot, ioh, IT8712_ADDR, index);
        bus_space_write_1(iot, ioh, IT8712_DATA, val);
}

static void
it8712_pnp_enter(lpctag_t tag)
{
        gemini_lpc_softc_t *sc = tag;
        bus_space_tag_t iot = sc->sc_iot;
        bus_space_handle_t ioh = sc->sc_ioh;

        bus_space_write_1(iot, ioh, IT8712_ADDR, 0x87);
        bus_space_write_1(iot, ioh, IT8712_ADDR, 0x01);
        bus_space_write_1(iot, ioh, IT8712_ADDR, 0x55);
        bus_space_write_1(iot, ioh, IT8712_ADDR, 0x55);
}

static void
it8712_pnp_exit(lpctag_t tag)
{
        gemini_lpc_softc_t *sc = tag;
        bus_space_tag_t iot = sc->sc_iot;
        bus_space_handle_t ioh = sc->sc_ioh;

        bus_space_write_1(iot, ioh, IT8712_ADDR, IT8712_CFGCTL);
        bus_space_write_1(iot, ioh, IT8712_DATA, CFGCTL_WAITKEY);
}

static void *
it8712_intr_establish(lpctag_t tag, uint intr, int ipl, int ist,
        int (*func)(void *), void *arg)
{
        gemini_lpc_softc_t *sc = tag;
        void *ih;

        ih = gemini_lpchc_intr_establish(sc->sc_lpchctag, intr, ipl, ist, func, arg);
        
        return ih;
}

static void
it8712_intr_disestablish(lpctag_t tag, void *ih)
{
        gemini_lpc_softc_t *sc = tag;

        gemini_lpchc_intr_disestablish(sc->sc_lpchctag, ih);
}