Source-Changes-HG archive

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index][Old Index]

[src/trunk]: src/sys/dev/i2c Add driver for TI TWL4030 Power Management IC



details:   https://anonhg.NetBSD.org/src/rev/214b9149281f
branches:  trunk
changeset: 1004505:214b9149281f
user:      jmcneill <jmcneill%NetBSD.org@localhost>
date:      Wed Oct 30 21:38:28 2019 +0000

description:
Add driver for TI TWL4030 Power Management IC

diffstat:

 sys/dev/i2c/files.i2c |    7 +-
 sys/dev/i2c/twl4030.c |  281 ++++++++++++++++++++++++++++++++++++++++++++++++++
 2 files changed, 287 insertions(+), 1 deletions(-)

diffs (truncated from 303 to 300 lines):

diff -r e1dab76b4b55 -r 214b9149281f sys/dev/i2c/files.i2c
--- a/sys/dev/i2c/files.i2c     Wed Oct 30 21:37:56 2019 +0000
+++ b/sys/dev/i2c/files.i2c     Wed Oct 30 21:38:28 2019 +0000
@@ -1,4 +1,4 @@
-#      $NetBSD: files.i2c,v 1.101 2019/10/27 20:11:13 jmcneill Exp $
+#      $NetBSD: files.i2c,v 1.102 2019/10/30 21:38:28 jmcneill Exp $
 
 obsolete defflag       opt_i2cbus.h            I2C_SCAN
 define i2cbus { }
@@ -373,3 +373,8 @@
 device pcapwm: pwm
 attach pcapwm at iic
 file   dev/i2c/pca9685.c                       pcapwm
+
+# TI TWL4030 Power Management IC
+device twl
+attach twl at iic
+file   dev/i2c/twl4030.c                       twl
diff -r e1dab76b4b55 -r 214b9149281f sys/dev/i2c/twl4030.c
--- /dev/null   Thu Jan 01 00:00:00 1970 +0000
+++ b/sys/dev/i2c/twl4030.c     Wed Oct 30 21:38:28 2019 +0000
@@ -0,0 +1,281 @@
+/* $NetBSD: twl4030.c,v 1.1 2019/10/30 21:38:28 jmcneill Exp $ */
+
+/*-
+ * Copyright (c) 2019 Jared McNeill <jmcneill%invisible.ca@localhost>
+ * 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 NETBSD FOUNDATION, INC. AND CONTRIBUTORS
+ * ``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 FOUNDATION OR CONTRIBUTORS
+ * 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: twl4030.c,v 1.1 2019/10/30 21:38:28 jmcneill Exp $");
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/kernel.h>
+#include <sys/device.h>
+#include <sys/conf.h>
+#include <sys/bus.h>
+#include <sys/kmem.h>
+#include <sys/gpio.h>
+
+#include <dev/i2c/i2cvar.h>
+
+#include <dev/fdt/fdtvar.h>
+
+#define        TWL_PIN_COUNT   16
+
+/* TWL4030 is a multi-function IC. Each module is at a separate I2C address */
+#define        ADDR_USB        0x00
+#define        ADDR_INT        0x01
+#define        ADDR_AUX        0x02
+#define        ADDR_POWER      0x03
+
+/* GPIO registers */
+#define        GPIOBASE                0x98
+#define        GPIODATAIN(pin)         (GPIOBASE + 0x00 + (pin) / 8)
+#define        GPIODATADIR(pin)        (GPIOBASE + 0x03 + (pin) / 8)
+#define        CLEARGPIODATAOUT(pin)   (GPIOBASE + 0x09 + (pin) / 8)
+#define        SETGPIODATAOUT(pin)     (GPIOBASE + 0x0c + (pin) / 8)
+#define         PIN_BIT(pin)           __BIT((pin) % 8)
+#define        GPIOPUPDCTR(pin)        (GPIOBASE + 0x13 + (n) / 4)
+#define         PUPD_BITS(pin)         __BITS((pin) % 4 + 1, (pin) % 4)
+
+struct twl_softc {
+       device_t        sc_dev;
+       i2c_tag_t       sc_i2c;
+       i2c_addr_t      sc_addr;
+       int             sc_phandle;
+
+       int             sc_npins;
+};
+
+struct twl_pin {
+       struct twl_softc        *pin_sc;
+       int                     pin_num;
+       int                     pin_flags;
+       bool                    pin_actlo;
+};
+
+static const struct device_compatible_entry compat_data[] = {
+       { "ti,twl4030",                 0 },
+       { NULL,                         0 }
+};
+
+static const char * const gpio_compatible[] = { "ti,twl4030-gpio", NULL };
+
+static uint8_t
+twl_read(struct twl_softc *sc, uint8_t mod, uint8_t reg, int flags)
+{
+       uint8_t val = 0;
+       int error;
+
+       error = iic_exec(sc->sc_i2c, I2C_OP_READ_WITH_STOP, sc->sc_addr + mod,
+           &reg, 1, &val, 1, flags);
+       if (error != 0)
+               aprint_error_dev(sc->sc_dev, "error reading reg %#x: %d\n", reg, error);
+
+       return val;
+}
+
+static void
+twl_write(struct twl_softc *sc, uint8_t mod, uint8_t reg, uint8_t val, int flags)
+{
+       uint8_t buf[2];
+       int error;
+
+       buf[0] = reg;
+       buf[1] = val;
+
+       error = iic_exec(sc->sc_i2c, I2C_OP_WRITE_WITH_STOP, sc->sc_addr + mod,
+           NULL, 0, buf, 2, flags);
+       if (error != 0)
+               aprint_error_dev(sc->sc_dev, "error writing reg %#x: %d\n", reg, error);
+}
+
+#define        I2C_LOCK(sc)            iic_acquire_bus((sc)->sc_i2c, I2C_F_POLL)
+#define        I2C_UNLOCK(sc)          iic_release_bus((sc)->sc_i2c, I2C_F_POLL)
+
+#define        INT_READ(sc, reg)       twl_read((sc), ADDR_INT, (reg), I2C_F_POLL)
+#define        INT_WRITE(sc, reg, val) twl_write((sc), ADDR_INT, (reg), (val), I2C_F_POLL)
+
+static int
+twl_gpio_config(struct twl_softc *sc, int pin, int flags)
+{
+       uint8_t dir;
+
+       KASSERT(pin >= 0 && pin < sc->sc_npins);
+
+       dir = INT_READ(sc, GPIODATADIR(pin));
+
+       switch (flags & (GPIO_PIN_INPUT|GPIO_PIN_OUTPUT)) {
+       case GPIO_PIN_INPUT:
+               dir &= ~PIN_BIT(pin);
+               break;
+       case GPIO_PIN_OUTPUT:
+               dir |= PIN_BIT(pin);
+               break;
+       default:
+               return EINVAL;
+       }
+
+       INT_WRITE(sc, GPIODATADIR(pin), dir);
+
+       return 0;
+}
+
+static void *
+twl_gpio_acquire(device_t dev, const void *data, size_t len, int flags)
+{
+       struct twl_softc * const sc = device_private(dev);
+       struct twl_pin *gpin;
+       const u_int *gpio = data;
+       int error;
+
+       if (len != 12)
+               return NULL;
+
+       const uint8_t pin = be32toh(gpio[1]) & 0xff;
+       const bool actlo = (be32toh(gpio[2]) & __BIT(0)) != 0;
+       
+       if (pin >= sc->sc_npins)
+               return NULL;
+
+       I2C_LOCK(sc);
+       error = twl_gpio_config(sc, pin, flags);
+       I2C_UNLOCK(sc);
+
+       if (error != 0) {
+               device_printf(dev, "bad pin %d config %#x\n", pin, flags);
+               return NULL;
+       }
+
+       gpin = kmem_zalloc(sizeof(*gpin), KM_SLEEP);
+       gpin->pin_sc = sc;
+       gpin->pin_num = pin;
+       gpin->pin_flags = flags;
+       gpin->pin_actlo = actlo;
+
+       return gpin;
+}
+
+static void
+twl_gpio_release(device_t dev, void *priv)
+{
+       struct twl_softc * const sc = device_private(dev);
+       struct twl_pin *gpin = priv;
+
+       I2C_LOCK(sc);
+       twl_gpio_config(sc, gpin->pin_num, GPIO_PIN_INPUT);
+       I2C_UNLOCK(sc);
+
+       kmem_free(gpin, sizeof(*gpin));
+}
+
+static int
+twl_gpio_read(device_t dev, void *priv, bool raw)
+{
+       struct twl_softc * const sc = device_private(dev);
+       struct twl_pin *gpin = priv;
+       uint8_t gpio;
+       int val;
+
+       I2C_LOCK(sc);
+       gpio = INT_READ(sc, GPIODATAIN(gpin->pin_num));
+       I2C_UNLOCK(sc);
+
+       val = __SHIFTOUT(gpio, PIN_BIT(gpin->pin_num));
+       if (!raw && gpin->pin_actlo)
+               val = !val;
+
+       return val;
+}
+
+static void
+twl_gpio_write(device_t dev, void *priv, int val, bool raw)
+{
+       struct twl_softc * const sc = device_private(dev);
+       struct twl_pin *gpin = priv;
+
+       if (!raw && gpin->pin_actlo)
+               val = !val;
+
+       I2C_LOCK(sc);
+       if (val)
+               INT_WRITE(sc, SETGPIODATAOUT(gpin->pin_num), PIN_BIT(gpin->pin_num));
+       else
+               INT_WRITE(sc, CLEARGPIODATAOUT(gpin->pin_num), PIN_BIT(gpin->pin_num));
+       I2C_UNLOCK(sc);
+}
+
+static struct fdtbus_gpio_controller_func twl_gpio_funcs = {
+       .acquire = twl_gpio_acquire,
+       .release = twl_gpio_release,
+       .read = twl_gpio_read,
+       .write = twl_gpio_write,
+};
+
+static void
+twl_gpio_attach(struct twl_softc *sc, const int phandle)
+{
+       fdtbus_register_gpio_controller(sc->sc_dev, phandle, &twl_gpio_funcs);
+}
+
+static int
+twl_match(device_t parent, cfdata_t match, void *aux)
+{
+       struct i2c_attach_args *ia = aux;
+       int match_result;
+
+       if (iic_use_direct_match(ia, match, compat_data, &match_result))
+               return match_result;
+
+       return 0;
+}
+
+static void
+twl_attach(device_t parent, device_t self, void *aux)
+{
+       struct twl_softc * const sc = device_private(self);
+       struct i2c_attach_args *ia = aux;
+       int child;
+
+       sc->sc_dev = self;
+       sc->sc_i2c = ia->ia_tag;
+       sc->sc_addr = ia->ia_addr;
+       sc->sc_phandle = ia->ia_cookie;
+       sc->sc_npins = TWL_PIN_COUNT;
+
+       aprint_naive("\n");
+       aprint_normal(": TWL4030");
+
+       for (child = OF_child(sc->sc_phandle); child; child = OF_peer(child)) {
+               if (of_match_compatible(child, gpio_compatible)) {
+                       aprint_normal(", GPIO");
+                       twl_gpio_attach(sc, child);
+               }
+       }
+       aprint_normal("\n");
+}



Home | Main Index | Thread Index | Old Index