#include <sys/cdefs.h>
#include "opt_platform.h"
#include <sys/param.h>
#include <sys/bus.h>
#include <sys/gpio.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <sys/systm.h>
#include <dev/gpio/gpiobusvar.h>
#include <dev/iicbus/iicbus.h>
#include <dev/iicbus/mux/iicmux.h>
#ifdef FDT
#include <dev/ofw/ofw_bus.h>
#include <dev/ofw/ofw_bus_subr.h>
#include <dev/ofw/openfirm.h>
static struct ofw_compat_data compat_data[] = {
{"i2c-mux-gpio", true},
{NULL, false}
};
OFWBUS_PNP_INFO(compat_data);
SIMPLEBUS_PNP_INFO(compat_data);
#endif
#include <dev/iicbus/iiconf.h>
#include "iicmux.h"
#include "iicmux_if.h"
struct gpiomux_softc {
struct iicmux_softc mux;
int idleidx;
int numpins;
gpio_pin_t pins[IICMUX_MAX_BUSES];
};
#define IDLE_NOOP (-1)
static int
gpiomux_bus_select(device_t dev, int busidx, struct iic_reqbus_data *rd)
{
struct gpiomux_softc *sc = device_get_softc(dev);
int i;
if (busidx == IICMUX_SELECT_IDLE) {
if (sc->idleidx == IDLE_NOOP)
return (0);
busidx = sc->idleidx;
}
for (i = 0; i < sc->numpins; ++i)
gpio_pin_set_active(sc->pins[i], busidx & (1u << i));
return (0);
}
static int
gpiomux_probe(device_t dev)
{
int rv;
rv = ENXIO;
#ifdef FDT
if (ofw_bus_status_okay(dev) &&
ofw_bus_search_compatible(dev, compat_data)->ocd_data)
rv = BUS_PROBE_DEFAULT;
#endif
device_set_desc(dev, "I2C GPIO Mux");
return (rv);
}
static void
gpiomux_release_pins(struct gpiomux_softc *sc)
{
int i;
for (i = 0; i < sc->numpins; ++i)
gpio_pin_release(sc->pins[i]);
}
static int
gpiomux_attach(device_t dev)
{
struct gpiomux_softc *sc = device_get_softc(dev);
ssize_t len;
device_t busdev;
int err, i, idlebits, numchannels;
pcell_t propval;
phandle_t node;
node = ofw_bus_get_node(dev);
for (i = 0; ; ++i) {
err = gpio_pin_get_by_ofw_propidx(dev, node, "mux-gpios", i,
&sc->pins[i]);
if (err != 0) {
break;
}
}
sc->numpins = i;
if (sc->numpins == 0) {
device_printf(dev, "cannot acquire pins listed in mux-gpios\n");
if (err == 0)
err = ENXIO;
goto errexit;
}
numchannels = 1u << sc->numpins;
if (numchannels > IICMUX_MAX_BUSES) {
device_printf(dev, "too many mux-gpios pins for max %d buses\n",
IICMUX_MAX_BUSES);
err = EINVAL;
goto errexit;
}
len = OF_getencprop(node, "i2c-parent", &propval, sizeof(propval));
if (len != sizeof(propval)) {
device_printf(dev, "cannot obtain i2c-parent property\n");
err = ENXIO;
goto errexit;
}
busdev = OF_device_from_xref((phandle_t)propval);
if (busdev == NULL) {
device_printf(dev,
"cannot find device referenced by i2c-parent property\n");
err = ENXIO;
goto errexit;
}
device_printf(dev, "upstream bus is %s\n", device_get_nameunit(busdev));
len = OF_getencprop(node, "idle-state", &propval, sizeof(propval));
if (len == sizeof(propval)) {
if ((int)propval >= numchannels) {
device_printf(dev,
"idle-state property %d exceeds channel count\n",
propval);
}
sc->idleidx = (int)propval;
idlebits = sc->idleidx;
} else {
sc->idleidx = IDLE_NOOP;
idlebits = 0;
}
for (i = 0; i < sc->numpins; ++i) {
gpio_pin_setflags(sc->pins[i], GPIO_PIN_OUTPUT);
gpio_pin_set_active(sc->pins[i], idlebits & (1u << i));
}
if ((err = iicmux_attach(dev, busdev, numchannels)) == 0)
bus_attach_children(dev);
errexit:
if (err != 0)
gpiomux_release_pins(sc);
return (err);
}
static int
gpiomux_detach(device_t dev)
{
struct gpiomux_softc *sc = device_get_softc(dev);
int err;
if ((err = iicmux_detach(dev)) != 0)
return (err);
gpiomux_release_pins(sc);
return (0);
}
static device_method_t gpiomux_methods[] = {
DEVMETHOD(device_probe, gpiomux_probe),
DEVMETHOD(device_attach, gpiomux_attach),
DEVMETHOD(device_detach, gpiomux_detach),
DEVMETHOD(iicmux_bus_select, gpiomux_bus_select),
DEVMETHOD_END
};
DEFINE_CLASS_1(iic_gpiomux, iic_gpiomux_driver, gpiomux_methods,
sizeof(struct gpiomux_softc), iicmux_driver);
DRIVER_MODULE(iic_gpiomux, simplebus, iic_gpiomux_driver, 0, 0);
DRIVER_MODULE(iic_gpiomux, ofw_simplebus, iic_gpiomux_driver, 0, 0);
#ifdef FDT
DRIVER_MODULE(ofw_iicbus, iic_gpiomux, ofw_iicbus_driver, 0, 0);
#else
DRIVER_MODULE(iicbus, iic_gpiomux, iicbus_driver, 0, 0);
#endif
MODULE_DEPEND(iic_gpiomux, iicmux, 1, 1, 1);
MODULE_DEPEND(iic_gpiomux, iicbus, 1, 1, 1);