[src/trunk]: src/sys/dev/i2c Add SD0 regulator.

[jmcneill <jmcneill%NetBSD.org@localhost>]

details:   https://anonhg.NetBSD.org/src/rev/1d93f29676f7
branches:  trunk
changeset: 823440:1d93f29676f7
user:      jmcneill <jmcneill%NetBSD.org@localhost>
date:      Sat Apr 22 23:46:29 2017 +0000

description:
Add SD0 regulator.

diffstat:

 sys/dev/i2c/as3722.c |  107 ++++++++++++++++++++++++++++++++++++++++++++++++--
 1 files changed, 101 insertions(+), 6 deletions(-)

diffs (178 lines):

diff -r 8594fc4d97a9 -r 1d93f29676f7 sys/dev/i2c/as3722.c
--- a/sys/dev/i2c/as3722.c      Sat Apr 22 23:01:36 2017 +0000
+++ b/sys/dev/i2c/as3722.c      Sat Apr 22 23:46:29 2017 +0000
@@ -1,4 +1,4 @@
-/* $NetBSD: as3722.c,v 1.7 2017/04/22 21:48:56 jmcneill Exp $ */
+/* $NetBSD: as3722.c,v 1.8 2017/04/22 23:46:29 jmcneill Exp $ */
 
 /*-
  * Copyright (c) 2015 Jared D. McNeill <jmcneill%invisible.ca@localhost>
@@ -29,7 +29,7 @@
 #include "opt_fdt.h"
 
 #include <sys/cdefs.h>
-__KERNEL_RCSID(0, "$NetBSD: as3722.c,v 1.7 2017/04/22 21:48:56 jmcneill Exp $");
+__KERNEL_RCSID(0, "$NetBSD: as3722.c,v 1.8 2017/04/22 23:46:29 jmcneill Exp $");
 
 #include <sys/param.h>
 #include <sys/systm.h>
@@ -53,6 +53,8 @@
 
 #define AS3722_START_YEAR              2000
 
+#define AS3722_SD0_VOLTAGE_REG         0x00
+
 #define AS3722_GPIO0_CTRL_REG          0x08
 #define AS3722_GPIO0_CTRL_INVERT       __BIT(7)
 #define AS3722_GPIO0_CTRL_IOSF         __BITS(6,3)
@@ -102,23 +104,37 @@
 
        struct sysmon_wdog sc_smw;
        struct todr_chip_handle sc_todr;
+
+       uint8_t         sc_fuse[8];
 };
 
 #ifdef FDT
+static int     as3722reg_set_voltage_sd0(device_t, u_int, u_int);
+static int     as3722reg_get_voltage_sd0(device_t, u_int *);
+static int     as3722reg_set_voltage_ldo(device_t, u_int, u_int);
+static int     as3722reg_get_voltage_ldo(device_t, u_int *);
+
 static const struct as3722regdef {
        const char      *name;
        u_int           vsel_reg;
        u_int           vsel_mask;
        u_int           enable_reg;
        u_int           enable_mask;
-       u_int           n_voltages;
+       int             (*set)(device_t, u_int, u_int);
+       int             (*get)(device_t, u_int *);
 } as3722regdefs[] = {
+       { .name = "sd0",
+         .vsel_reg = AS3722_SD0_VOLTAGE_REG,
+         .vsel_mask = 0x7f,
+         .set = as3722reg_set_voltage_sd0,
+         .get = as3722reg_get_voltage_sd0 },
        { .name = "ldo6",
          .vsel_reg = AS3722_LDO6_VOLTAGE_REG,
          .vsel_mask = 0x7f,
          .enable_reg = AS3722_LDOCONTROL0_REG,
          .enable_mask = 0x40,
-         .n_voltages = 0x80 },
+         .set = as3722reg_set_voltage_ldo,
+         .get = as3722reg_get_voltage_ldo },
 };
 
 struct as3722reg_softc {
@@ -513,6 +529,9 @@
        const int flags = (cold ? I2C_F_POLL : 0);
        int error;
 
+       if (!regdef->enable_mask)
+               return enable ? 0 : EINVAL;
+
        iic_acquire_bus(asc->sc_i2c, flags);
        if (enable)
                error = as3722_set_clear(asc, regdef->enable_reg,
@@ -526,7 +545,7 @@
 }
 
 static int
-as3722reg_set_voltage(device_t dev, u_int min_uvol, u_int max_uvol)
+as3722reg_set_voltage_ldo(device_t dev, u_int min_uvol, u_int max_uvol)
 {
        struct as3722reg_softc *sc = device_private(dev);
        struct as3722_softc *asc = device_private(device_parent(dev));
@@ -563,7 +582,7 @@
 }
 
 static int
-as3722reg_get_voltage(device_t dev, u_int *puvol)
+as3722reg_get_voltage_ldo(device_t dev, u_int *puvol)
 {
        struct as3722reg_softc *sc = device_private(dev);
        struct as3722_softc *asc = device_private(device_parent(dev));
@@ -591,6 +610,82 @@
 
        return 0;
 }
+
+static int
+as3722reg_set_voltage_sd0(device_t dev, u_int min_uvol, u_int max_uvol)
+{
+       struct as3722reg_softc *sc = device_private(dev);
+       struct as3722_softc *asc = device_private(device_parent(dev));
+       const struct as3722regdef *regdef = sc->sc_regdef;
+       const int flags = (cold ? I2C_F_POLL : 0);
+       uint8_t set_v = 0x00;
+       u_int uvol;
+       int error;
+
+       for (uint8_t v = 0x01; v <= 0x5a; v++) {
+               uvol = 600000 + (v * 10000);
+               if (uvol >= min_uvol && uvol <= max_uvol) {
+                       set_v = v;
+                       goto done;
+               }
+       }
+       if (set_v == 0)
+               return ERANGE;
+
+done:
+       iic_acquire_bus(asc->sc_i2c, flags);
+       error = as3722_set_clear(asc, regdef->vsel_reg, set_v,
+           regdef->vsel_mask, flags);
+       iic_release_bus(asc->sc_i2c, flags);
+
+       return error;
+}
+
+static int
+as3722reg_get_voltage_sd0(device_t dev, u_int *puvol)
+{
+       struct as3722reg_softc *sc = device_private(dev);
+       struct as3722_softc *asc = device_private(device_parent(dev));
+       const struct as3722regdef *regdef = sc->sc_regdef;
+       const int flags = (cold ? I2C_F_POLL : 0);
+       uint8_t v;
+       int error;
+
+       iic_acquire_bus(asc->sc_i2c, flags);
+       error = as3722_read(asc, regdef->vsel_reg, &v, flags);
+       iic_release_bus(asc->sc_i2c, flags);
+       if (error != 0)
+               return error;
+
+       v &= regdef->vsel_mask;
+
+       if (v == 0)
+               *puvol = 0;     /* DC/DC powered down */
+       else if (v >= 0x01 && v <= 0x5a)
+               *puvol = 600000 + (v * 10000);
+       else
+               return EINVAL;
+
+       return 0;
+}
+
+static int
+as3722reg_set_voltage(device_t dev, u_int min_uvol, u_int max_uvol)
+{
+       struct as3722reg_softc *sc = device_private(dev);
+       const struct as3722regdef *regdef = sc->sc_regdef;
+
+       return regdef->set(dev, min_uvol, max_uvol);
+}
+
+static int
+as3722reg_get_voltage(device_t dev, u_int *puvol)
+{
+       struct as3722reg_softc *sc = device_private(dev);
+       const struct as3722regdef *regdef = sc->sc_regdef;
+
+       return regdef->get(dev, puvol);
+}
 #endif
 
 int