/*- * Copyright (c) 2016 Jared McNeill * * 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. * * $FreeBSD$ */ /* * Ingenic JZ4780 SMB Controller */ #include __FBSDID("$FreeBSD$"); #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "iicbus_if.h" #define JZSMB_TIMEOUT ((300UL * hz) / 1000) #define JZSMB_SPEED_STANDARD 100000 #define JZSMB_SETUP_TIME_STANDARD 300 #define JZSMB_HOLD_TIME_STANDARD 400 #define JZSMB_PERIOD_MIN_STANDARD 4000 #define JZSMB_PERIOD_MAX_STANDARD 4700 #define JZSMB_SPEED_FAST 400000 #define JZSMB_SETUP_TIME_FAST 450 #define JZSMB_HOLD_TIME_FAST 450 #define JZSMB_PERIOD_MIN_FAST 600 #define JZSMB_PERIOD_MAX_FAST 1300 #define JZSMB_HCNT_BASE 8 #define JZSMB_HCNT_MIN 6 #define JZSMB_LCNT_BASE 1 #define JZSMB_LCNT_MIN 8 static inline int tstohz(const struct timespec *tsp) { struct timeval tv; TIMESPEC_TO_TIMEVAL(&tv, tsp); return (tvtohz(&tv)); } static struct ofw_compat_data compat_data[] = { { "ingenic,jz4780-i2c", 1 }, { NULL, 0 } }; static struct resource_spec jzsmb_spec[] = { { SYS_RES_MEMORY, 0, RF_ACTIVE }, { -1, 0 } }; struct jzsmb_softc { struct resource *res; struct mtx mtx; clk_t clk; device_t iicbus; int busy; uint32_t i2c_freq; uint64_t bus_freq; uint32_t status; struct iic_msg *msg; }; #define SMB_LOCK(sc) mtx_lock(&(sc)->mtx) #define SMB_UNLOCK(sc) mtx_unlock(&(sc)->mtx) #define SMB_ASSERT_LOCKED(sc) mtx_assert(&(sc)->mtx, MA_OWNED) #define SMB_READ(sc, reg) bus_read_2((sc)->res, (reg)) #define SMB_WRITE(sc, reg, val) bus_write_2((sc)->res, (reg), (val)) static phandle_t jzsmb_get_node(device_t bus, device_t dev) { return (ofw_bus_get_node(bus)); } static int jzsmb_enable(struct jzsmb_softc *sc, int enable) { SMB_ASSERT_LOCKED(sc); if (enable) { SMB_WRITE(sc, SMBENB, SMBENB_SMBENB); while ((SMB_READ(sc, SMBENBST) & SMBENBST_SMBEN) == 0) ; } else { SMB_WRITE(sc, SMBENB, 0); while ((SMB_READ(sc, SMBENBST) & SMBENBST_SMBEN) != 0) ; } return (0); } static int jzsmb_reset_locked(device_t dev, u_char addr) { struct jzsmb_softc *sc; uint16_t con; uint32_t period; int hcnt, lcnt, setup_time, hold_time; sc = device_get_softc(dev); SMB_ASSERT_LOCKED(sc); /* Setup master mode operation */ /* Disable SMB */ jzsmb_enable(sc, 0); /* Disable interrupts */ SMB_WRITE(sc, SMBINTM, 0); /* Set supported speed mode and expected SCL frequency */ period = sc->bus_freq / sc->i2c_freq; con = SMBCON_REST | SMBCON_SLVDIS | SMBCON_MD; switch (sc->i2c_freq) { case JZSMB_SPEED_STANDARD: con |= SMBCON_SPD_STANDARD; setup_time = JZSMB_SETUP_TIME_STANDARD; hold_time = JZSMB_HOLD_TIME_STANDARD; hcnt = (period * JZSMB_PERIOD_MIN_STANDARD) / (JZSMB_PERIOD_MAX_STANDARD + JZSMB_PERIOD_MIN_STANDARD); lcnt = period - hcnt; hcnt = MAX(hcnt - JZSMB_HCNT_BASE, JZSMB_HCNT_MIN); lcnt = MAX(lcnt - JZSMB_LCNT_BASE, JZSMB_LCNT_MIN); SMB_WRITE(sc, SMBCON, con); SMB_WRITE(sc, SMBSHCNT, hcnt); SMB_WRITE(sc, SMBSLCNT, lcnt); break; case JZSMB_SPEED_FAST: con |= SMBCON_SPD_FAST; setup_time = JZSMB_SETUP_TIME_FAST; hold_time = JZSMB_HOLD_TIME_FAST; hcnt = (period * JZSMB_PERIOD_MIN_FAST) / (JZSMB_PERIOD_MAX_FAST + JZSMB_PERIOD_MIN_FAST); lcnt = period - hcnt; hcnt = MAX(hcnt - JZSMB_HCNT_BASE, JZSMB_HCNT_MIN); lcnt = MAX(lcnt - JZSMB_LCNT_BASE, JZSMB_LCNT_MIN); SMB_WRITE(sc, SMBCON, con); SMB_WRITE(sc, SMBFHCNT, hcnt); SMB_WRITE(sc, SMBFLCNT, lcnt); break; default: return (EINVAL); } setup_time = ((setup_time * sc->bus_freq / 1000) / 1000000) + 1; setup_time = MIN(1, MAX(255, setup_time)); SMB_WRITE(sc, SMBSDASU, setup_time); hold_time = ((hold_time * sc->bus_freq / 1000) / 1000000) - 1; hold_time = MAX(255, hold_time); if (hold_time >= 0) SMB_WRITE(sc, SMBSDAHD, hold_time | SMBSDAHD_HDENB); else SMB_WRITE(sc, SMBSDAHD, 0); SMB_WRITE(sc, SMBTAR, addr >> 1); if (addr != 0) { /* Enable SMB */ jzsmb_enable(sc, 1); } return (0); } static int jzsmb_reset(device_t dev, u_char speed, u_char addr, u_char *oldaddr) { struct jzsmb_softc *sc; int error; sc = device_get_softc(dev); SMB_LOCK(sc); error = jzsmb_reset_locked(dev, addr); SMB_UNLOCK(sc); return (error); } static int jzsmb_transfer_read(device_t dev, struct iic_msg *msg) { struct jzsmb_softc *sc; struct timespec start, diff; uint16_t con, resid; int timeo; sc = device_get_softc(dev); timeo = JZSMB_TIMEOUT * msg->len; SMB_ASSERT_LOCKED(sc); con = SMB_READ(sc, SMBCON); con |= SMBCON_STPHLD; SMB_WRITE(sc, SMBCON, con); getnanouptime(&start); for (resid = msg->len; resid > 0; resid--) { for (int i = 0; i < min(resid, 8); i++) SMB_WRITE(sc, SMBDC, SMBDC_CMD); for (;;) { getnanouptime(&diff); timespecsub(&diff, &start, &diff); if ((SMB_READ(sc, SMBST) & SMBST_RFNE) != 0) { msg->buf[msg->len - resid] = SMB_READ(sc, SMBDC) & SMBDC_DAT; break; } else DELAY(1000); if (tstohz(&diff) >= timeo) { device_printf(dev, "read timeout (status=0x%02x)\n", SMB_READ(sc, SMBST)); return (EIO); } } } con = SMB_READ(sc, SMBCON); con &= ~SMBCON_STPHLD; SMB_WRITE(sc, SMBCON, con); return (0); } static int jzsmb_transfer_write(device_t dev, struct iic_msg *msg, int stop_hold) { struct jzsmb_softc *sc; struct timespec start, diff; uint16_t con, resid; int timeo; sc = device_get_softc(dev); timeo = JZSMB_TIMEOUT * msg->len; SMB_ASSERT_LOCKED(sc); con = SMB_READ(sc, SMBCON); con |= SMBCON_STPHLD; SMB_WRITE(sc, SMBCON, con); getnanouptime(&start); for (resid = msg->len; resid > 0; resid--) { for (;;) { getnanouptime(&diff); timespecsub(&diff, &start, &diff); if ((SMB_READ(sc, SMBST) & SMBST_TFNF) != 0) { SMB_WRITE(sc, SMBDC, msg->buf[msg->len - resid]); break; } else DELAY((1000 * hz) / JZSMB_TIMEOUT); if (tstohz(&diff) >= timeo) { device_printf(dev, "write timeout (status=0x%02x)\n", SMB_READ(sc, SMBST)); return (EIO); } } } if (!stop_hold) { con = SMB_READ(sc, SMBCON); con &= ~SMBCON_STPHLD; SMB_WRITE(sc, SMBCON, con); } return (0); } static int jzsmb_transfer(device_t dev, struct iic_msg *msgs, uint32_t nmsgs) { struct jzsmb_softc *sc; uint32_t n; uint16_t con; int error; sc = device_get_softc(dev); SMB_LOCK(sc); while (sc->busy) mtx_sleep(sc, &sc->mtx, 0, "i2cbuswait", 0); sc->busy = 1; sc->status = 0; for (n = 0; n < nmsgs; n++) { /* Set target address */ if (n == 0 || msgs[n].slave != msgs[n - 1].slave) jzsmb_reset_locked(dev, msgs[n].slave); /* Set read or write */ if ((msgs[n].flags & IIC_M_RD) != 0) error = jzsmb_transfer_read(dev, &msgs[n]); else error = jzsmb_transfer_write(dev, &msgs[n], n < nmsgs - 1); if (error != 0) goto done; } done: /* Send stop if necessary */ con = SMB_READ(sc, SMBCON); con &= ~SMBCON_STPHLD; SMB_WRITE(sc, SMBCON, con); /* Disable SMB */ jzsmb_enable(sc, 0); sc->msg = NULL; sc->busy = 0; wakeup(sc); SMB_UNLOCK(sc); return (error); } static int jzsmb_probe(device_t dev) { if (!ofw_bus_status_okay(dev)) return (ENXIO); if (ofw_bus_search_compatible(dev, compat_data)->ocd_data == 0) return (ENXIO); device_set_desc(dev, "Ingenic JZ4780 SMB Controller"); return (BUS_PROBE_DEFAULT); } static int jzsmb_attach(device_t dev) { struct jzsmb_softc *sc; phandle_t node; int error; sc = device_get_softc(dev); node = ofw_bus_get_node(dev); mtx_init(&sc->mtx, device_get_nameunit(dev), "jzsmb", MTX_DEF); error = clk_get_by_ofw_index(dev, 0, 0, &sc->clk); if (error != 0) { device_printf(dev, "cannot get clock\n"); goto fail; } error = clk_enable(sc->clk); if (error != 0) { device_printf(dev, "cannot enable clock\n"); goto fail; } error = clk_get_freq(sc->clk, &sc->bus_freq); if (error != 0 || sc->bus_freq == 0) { device_printf(dev, "cannot get bus frequency\n"); return (error); } if (bus_alloc_resources(dev, jzsmb_spec, &sc->res) != 0) { device_printf(dev, "cannot allocate resources for device\n"); error = ENXIO; goto fail; } if (OF_getencprop(node, "clock-frequency", &sc->i2c_freq, sizeof(sc->i2c_freq)) != 0 || sc->i2c_freq == 0) sc->i2c_freq = 100000; /* Default to standard mode */ sc->iicbus = device_add_child(dev, "iicbus", -1); if (sc->iicbus == NULL) { device_printf(dev, "cannot add iicbus child device\n"); error = ENXIO; goto fail; } bus_generic_attach(dev); return (0); fail: bus_release_resources(dev, jzsmb_spec, &sc->res); if (sc->clk != NULL) clk_release(sc->clk); mtx_destroy(&sc->mtx); return (error); } static device_method_t jzsmb_methods[] = { /* Device interface */ DEVMETHOD(device_probe, jzsmb_probe), DEVMETHOD(device_attach, jzsmb_attach), /* Bus interface */ DEVMETHOD(bus_setup_intr, bus_generic_setup_intr), DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr), DEVMETHOD(bus_alloc_resource, bus_generic_alloc_resource), DEVMETHOD(bus_release_resource, bus_generic_release_resource), DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), DEVMETHOD(bus_adjust_resource, bus_generic_adjust_resource), DEVMETHOD(bus_set_resource, bus_generic_rl_set_resource), DEVMETHOD(bus_get_resource, bus_generic_rl_get_resource), /* OFW methods */ DEVMETHOD(ofw_bus_get_node, jzsmb_get_node), /* iicbus interface */ DEVMETHOD(iicbus_callback, iicbus_null_callback), DEVMETHOD(iicbus_reset, jzsmb_reset), DEVMETHOD(iicbus_transfer, jzsmb_transfer), DEVMETHOD_END }; static driver_t jzsmb_driver = { "iichb", jzsmb_methods, sizeof(struct jzsmb_softc), }; static devclass_t jzsmb_devclass; EARLY_DRIVER_MODULE(iicbus, jzsmb, iicbus_driver, iicbus_devclass, 0, 0, BUS_PASS_RESOURCE + BUS_PASS_ORDER_MIDDLE); EARLY_DRIVER_MODULE(jzsmb, simplebus, jzsmb_driver, jzsmb_devclass, 0, 0, BUS_PASS_RESOURCE + BUS_PASS_ORDER_MIDDLE); MODULE_VERSION(jzsmb, 1);